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ABSTRACT 


The performance of an extended Kalman filter used to track a maneuvering surface 
target using HFDF lines-of-bearing is substantially improved by implementing a fixed 
interval smoothing algorithm and a maneuver detection method that uses a noise vari- 
ance estimator process. This tracking routine is designed and implemented in a com- 
puter program developed for this thesis. The Hall noise model is used to accurately 
evaluate the performance of the tracking algorithm in a noisy environment. Several 
tracking scenarios are simulated and analyzed. The application of the Kalman tracker 
to a tropical storm tracking problem 1s investigated. Actual storm tracks obtained from 


the Joint Typhoon Warning Center in Guam, Mariana Islands are used for this research. 


THESIS DISCLAIMER 


The reader is cautioned that computer programs developed in this research may not 
have been exercised for all cases of interest. While every effort has been made, within 
the time available, to ensure that the programs are free of computational and logic er- 
rors, they cannot be considered validated. Any application of these programs without 


additional verification is at the risk of the user. 
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I. INTRODUCTION. 


In 1986, then Deputy Chief of Naval Operations for Surface Warfare (OP-03), Vice 
Admiral Joseph Metcalf III challenged the leadership of the U.S. Navy's Surface War- 
fare community to reexamine the traditional concepts of surface warfare-concepts that 
perhaps are preventing the Navy from taking full advantage of present and future tech- 
nologies. Thus began Surface Warfare’s Revolution at Sea. A vital concept to the 
“Revolution at Sea” is the constantly expanding oceanic battle space (“up, out, and 
Gown ). (Ref. 1] 

With the advent of the modern tong range cruise missile, U.S. surface forces have 
the capability to attack enemy surface targets at 250 nautical miles. In order to make 
full use of this capability however, an accurate and reliable method of over-the-horizon 
tracking and targeting is necessary. The current methods used to target an enemy sur- 
face force at these ranges include the use of satelthtes. aircraft, and intelligence sources. 
A major drawback to using these assets 1s the requirement that thev transmit vital tar- 
geting information to the attacking ship. A shipboard surveillance svstem that provides 
this information locally would allow the attacking forces to operate independently 
without relying on other sources for targeting data, data that may or may not be avail- 
able when needed for a number of reasons. In addition, the abihty to operate covertly, 
and to track and target enemy forces without divulging any targeting information, 
greatly enhances the probability of success of a mission. This requires a passive acqui- 
sition svstem. Surveillance of the high frequency spectrum using passive radio-direction 
finding (RDF) sensors is one method of passive long range tracking. A shipboard high 
frequencv-direction finding svstem based on an extended Kalman filter with a fixed in- 
terval smoothing algorithm can be used to accurately track and target a maneuvering 
surface ship. 

The major thrust of this thesis deals with the problem of tracking a surface ship at 
long ranges using hnes-of-bearing obtained from radio direction-finding sensors located 
On two tracking ships. It is not the purpose of this research to address the multitude 
of probiems associated with the hardware aspects of a high frequency radio direction- 
finding system. The basic assumption used here is that a shipboard direction-finding 
system is in place that provides a line-of-bearing contaminated by an additive noise 


process. The extended Kalman filter and the fixed interval smoothing algorithm will be 


used to refine the observed lines-of-bearing and improve the accuracy of the target track. 
The noise added to the observed line-of-bearing is an integral part of the measurement 
model and should reflect the noise process that would be encountered in the HF envi- 
ronment as accurately as possible. For the simulations conducted, this measurement 
noise was modeled using first a white noise model and then with a Hall noise model. 
This thesis will be an extension of a previous thesis done by Lieutenant Thomas K. 


Bennett. The major points of that thesis are: 


e The development of an extended Kalman filter shiptracking program. 
e The observations used in the shiptracking program were RDF lines-of bearing. 


e The position errors achieved by this program were 10-15 nautical mules. 


This thesis will attempt to improve on the previous research by implementing a fixed 
interval smoothing algorithm and a maneuver divergence detection scheme that uses a 
noise variance estimator process. The smoothing algorithm is an off-line calculation 
that uses all measurements taken during a time interval 0<4< MV to improve the esti- 
mate. By having a more accurate assessment of what the target has done in the past, 
we will be better able to predict ahead and estimate a target’s future course, speed, and 
position. The computational aspects of the smoothing algorithm will be investigated as 
Well as the types of estimation problems where the improvement due to the smoothed 
calculations ts significant and worth the extra computational effort. The two noise 
models used in the simulations will be compared as to their accuracy and their advan- 
tages or disadvantages of one or the other based on the computer simulations. 

The tracking of a tropical storm is a problem similar to the ship tracking problem 
and is discussed in Chapter 5. The major difference between the filtering applications 1s 
that the measurement data in the storm tracker are actual position coordinates given by 
latitude and longitude values. This leads to a linear measurement process and therefore, 
the linearization required in the ship tracking problem is unnecessary in the storm 


tracking scenario. 


tJ 


I. PROBLEM STATEMENT 
be GENERAL 


The tracking scenario used in this thesis involves two tracking ships moving in the 
general direction toward a target ship. The positions of the vessels are given in x,y co- 


ordinates. The target-tracker scenario 1s shown 1n Figure I. 


N 


pe" 
V vail | . 


Figure 1. Surface Tracking Geometry 


This problem will be developed using state space methods. Given the lines-of- 
bearing {the measurements) received by a radio direction-finding system, we are inter- 
ested in estimating the location, course, and speed of the target (the states of the plant). 


The state vaniablesfor thisiplant are xf yea 


B. SYSTEM MODEL 
The svstem to be modeled in this problem 1s that of a surface ship at sea. In the 


development of this model, the following assumptions were made. 
e The effect of wind, current, and hydrodynamic forces on the ship are neglected. 
e The curvature of the earth 1s neglected; ocean Sutiace areasise ae 


e Course and speed inputs are constant (1.e., step inputs). 


This is a linear, trme-distance svstem that can be described with the equations of motion 


for constant acceleration in two dimensions. The state space equation 1s 
= a 
Xysy = Pedy + yay (2.1) 


where 
x,= parameter to be estimated (state vector). 


d,= state transition matrix which describes how the states of the dynamic svstem are 
related 


T,= system noise coefficient matrix 


a,= random forcing function. 


From Equation (2.1) and the above assumptions, the state vector is 


=. 


and the svstem state equation can be expanded as 


To 
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The system noise process for the ship tracking problem is a function of the noise coeffi- 
| cient matrix, [,, and the random forcing function, a,, which is simply the acceleration 


Wector. 


C. MEASUREMENT MODEL 
For a linear measurement process, the measurements are linearlv related to the state 


variables and can be modeled using the linear measurement equation 
Zp = HiXy + Xp (2.4) 


where 
z,= set of measurements. 


H,= observation matrix that gives the noiseless relationship between the measure- 
ments and the state vector. 


X,= state vector 


y,= measurement noise. 


In this tracking problem, the measurements are the lines-of-bearing received bv the 
radio direction-finding sensors located on two surface ships. For the geometry of the 
problem shown in Figure 1, the relationship of the measurements to the state variables 


is not linear and the measurement equation becomes 


—| (7p - Mie) . 
z,,=tan ||] —A "4g, (2.5) 
- G ee ink) 


where 
Z,4.— Observed lines of bearing at time k 
Xue ¥x= position of target at time k 
Xi ¥,,= position of sensor n at time k 


v= measurement noise. 


This nonlinear equation must be linearized prior to processing the measurement data 
with the filter and the smoothing algorithm. For this problem, an extended Kalman fil- 
ter 1s required and will be discussed in the next chapter. 

There are several types of noise that affect the propagation of radio signals, how- 
ever, this noise can basically be divided into two categories, depending on whether it 
Originates from within the receiving svstem or external to the receiving antenna. For the 


frequencies of interest in this problem (2-30 MHz), it is the atmospheric noise external 


to the receiving system that is of the greatest concern. [Ref. 2: p. 4] This noise is a 
function of manv variables including the time of day, geographical location, season, and 
frequency. Although this is generally a non-white, non-gaussian noise process, it can 
be adequately described as a white noise process over an extended period of time. The 
white noise model was used for the first set of computer simulations. 

A deficiency of white noise as a model for atmospheric noise, is its inability to ac- 
curately model the impulsive nature of the atmospheric noise associated with hghtning 
discharges. This impulsive noise characteristic was investigated by Hall [Ref. 3] and led 


to the development of Hall's generalized “t” model which has the form 
x(t) = m(nn(r) (2.6) 


where (rf) is a slowly varving stationary random process independent of n(r) and x(t) 1s 
a zero mean, narrowband Gaussian process. The complete development of this model 
can be found in Hall [Ref. 3]. 

In [Ref. 4: pp. 13-35], Spaulding outlines a method of generating random noise 
samples using the Hall model. The procedure for calculating these random samples 
starts bv generating random samples from a uniform distribution, J’, in the interval from 
zero to one and then modifying the sample according to the distribution required. For 


the Hall model, the random noise samples are obtained using the equation 


=) 


X,= (Ver -1)? (2.7) 


where © = 4 and y = 0.707. These values for © and y were chosen using the atmospheric 
noise curves in [Ref. 3: p. 44]. The positive bias in the Hall model was subtracted out 
prior to inserting the noise data into the ship tracking algorithm. Thus was done in order 
tO prevent a biased error covariance in the Kalman filter. The two noise models are 


shown in Figures 2 and 3. Both noise processes are zero mean and + 3 variance. 





IH. KALMAN FILTER THEORY 


A. GENERAL 

Filtering refers to the process of estimating the state vector at the current time based 
upon all past measurements. An optimal filter concentrates on optimizing a specific 
performance measure used to approximate the qualitv of the estimate. The Kalman fil- 
ter is the optimal filter in a class of linear filters that minimize the mean square esti- 
mation error between the actual and desired output. In other words, the Kalman filter 
attempts to nunimize the elements along the main diagonal of the state error covariance 
matrix. The filter itself is actually a recursive algorithm for processing discrete meas- 
urements or observations in an optimal manner. [Ref. 5: p. 101] It requires a priori 
knowledge of the state estimate (x,_,) and its error covariance (?,_,), and the Gumems 
observauon (z,). The Kalman filter is the proper algorithm to be used when both the 
svstem model and the measurement model are linear functions of the state variables and 


these models can be described by the equations 
Xie = Pte tT pe (3.1) 
ae pee A . a 
£k ~ {1X j ale Le (335 


B. EXTENDED KALMAN FILTER 

From equation (2.5), we can see that there 1s a nonlinear relationship between the 
observed lines-of-bearing and the state variables. The adaptation of the Kalman filter 
to a nonlinear application is the extended Kalman filter. The nonlinear measurement 


equation 1s 
Zp = A(z, k) FY, (3:33) 


where the observation matrix (/,) is a function of the state at each sampling time and 
the sampling index &. Linearization of this equation can be accomplished by expanding 
hin a Tavlor series about an estimated trajectory that is continually updated with the 
filter’s estimates. By keeping only the first term of the series expansion, a first order 
approximation is obtained. Higher order, more precise filters can be constructed by in- 


cluding more terms of the Taylor series expansion for the nonlinearities, and deriving 


recursive relations for the higher moments of the state vector. A detailed discussion of 
this procedure can be found in Gelb [Ref. 5: p. 100}. 


This linearization process vields the linear measurement equation 


2p ee 1 Vic (3.4) 
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Applying this linearization method to equation (2.5), We get 
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By replacing };, with J.a,-1 in equation (3.8) and x, with x, im equations: jal0jmiee 


linearized measurement matrix can be written as 


(¥" jae a, (x =| ) 
eh = UR|k - n 0 _ (R|k ~ nk h Ga 12) 
Ri Ry 


where the range (R) 1s computed as 


ne A 2 A 2 
Ro = Viet) ae eee ee ee (32153) 


Having hnearized the measurement process about X,,-1, Where X,,-;, denotes the state 
estimate at time & based on all previous estimates computed at time A — 1, we can now 


use the normal hnear Kalman filter equations. 


C. NOISE PROCESSES 
The calculation of the error covariance matrix and the filter gain matrix requires the 
covariance matrices for the uncorrelated noise process a, and x,. For the measurement 


noise process v,, the covariance matrix 1s 
tN : 
Ei =k. (3.14) 


Where &, 1s defined as the state measurement noise covariance matrix. It 1s based on the 
sensor accuracy and accounts for unknown disturbances such as steps, white noise, or 
imperfections in the plant model. The variance of the white noise model and the Hall 
noise model used in the computer simulations was + 3 degrees. 


The state excitation matrix, O 


used in the Kalman filter represents the system noise 
process and 1s a function of the system noise coefficient matrix, T,, and the random 


forcing function. a@,, where 
ak 
On = (PQ lJ (3.15) 
wihere.@ pls -cetued 
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O', = ELaazj = 
S| Elaytad Ela] 


(3.16) 


and IT, 1s the same as in equation (2.3). The Q, matrix allows for any random target 


maneuvers as Well as inaccuracies in the system model. The magnitude of Q, has a direct 
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bearing on the magnitude of the state error covariance matrix and it prevents the 
covariance matrix from becoming singular by ensuring some uncertainty in the state es- 
timates. 


From Figure |, the velocity of the target 1s 


v, =v, sin ©, (aly) 
vy =v, cos ©, (3.18) 


Differentiating equations (3.17) and (3.18) to get the target’s acceleration 


“pees ~F Y 
b= i a | =F 10, v (G17) 


[ 


sy ‘ iE 
: y Ne 
a, = ‘| a | — 0) 7 | 


where 


Here +, and ©, are equal to the acceleration along the target’s course and the angular 


velocity or turn rate, respectively. Assuming that 
ate) = arr ya 
the variances become 
E[O;] = 96, (3.21) 
Eli] = 65, (3.22) 


Approximate values [Ref. 6: p. 39] for the standard deviations of the accelerations and 


the angular velocity are 


11 


decrees 





og, — 0. aera (3.265 
oy, = 0.01 AA (3.24) 
0 SEE wy 
and the variance values are 

52, = 0.01006) nee ame (3.25) 

sa nun 

2 n 2 

ois = 0.0001 3 : (3.26) 


Taking the expectation of equations (3.19) and (3.20) and substituting in equations 


(3-21) and (3.22) the elements of the? @mietuneane 


2 Pee ee 2 a) 2 
Elay,.| = o3,| T 1 Coe (3.20 
2 oi ead one perme < a 
ilk =, roe + 65;)"x (3.28) 
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D. INITIALIZATION AND OPERATION 

In the ship tracking scenario, the extended Kalman filter and the fixed interval 
smoothing algorithm are used to minimize the tracking errors. Prior to processing the 
measurement data, the filter must be initialized with an initial state estimate and an ini- 
tial error covariance matrix. This initialization process is a very important step in the 
filter operation and gross inaccuracies in this step may cause the filter to diverge. Dh- 
vergence occurs when the calculated covariance errors become much smaller than the 
actual covariance errors. This causes the actual values of the states to pull away from 
the estimated values. The concept of divergence will be discussed in greater detail in 


section E of this chapter. The initialization process is shown in Figure 4. 


INITIAL 
ESTIMATE 


(Xt, Yt) 


ACTUAL 
POSITION 


SENSOR 1 
i, 1) 


SENSOR 2 
(X2,Y2) 





Figure 4. ~—— [nitialization Process 


The state estimates are the target’s x and y position and the x and y components of 
the velocity. The initial positron estimate [Ref. 7: p. Il] is the intersection of the first two 


lines-of-bearing received by the filter and can be calculated as 


jo tan(@,) +3’, tan(@,) +x, — x, 
- tan(@,) — tan(@) 


-»| x tan(O,) + x, (3.30) 


yy tan(@,) + y, tan(@,) + x, — x, 3.31) 
i ae ee a . ae _ coceaa ie 
4 tan(0@,) — tan(@5) 
The mitral velocity estimate 1s taken to be zero since there is no velocity information 


available to start the problem. The initial state estimates carry with them some error 


and it is this error or rather an estimate of this error that is used to construct the initial 
error covariance matrix. The initial position error is estimated to be 100 nautical miles 
in the x and y position and the initial velocity estimate is taken to be 0.5 nautical miles 
per minute or 30 knots. The errors are assumed to be zero mean and uncorrelated. 


Given these error approximations, the initial error covariance matrix can be written as 


100000 0 


0 
0 OS 0 0 
0 
wy 


Po|-1) = (3.32) 


0 QO 10000 
0 0 0 O25 
The basic operation of the filter is a relatively straightforward recursive process. 


The equations used in the extended Kalman filter are 


Xue) = d Xceo (3.33) 

a) bxPrrnPn + Ox (3.34) 

G, = Patel: (Hee eee oe (3.33) 
Xue) = Xe) + Gylzy — 1 LX ue—1)) (5.36) 
Peay = — Olt) Peet) (3.37) 


Xi.) = projected ahead state estimate 
@, = Stat€ transition matnx einen by cae 3) 
Peicty = projected ahead state error covariance manu 


O, = state excitation covariance matrix given by eq. (3.15) 


oa 


G, = Kalman gain matrix 
R 


x 


= state measurement noise covariance matrix given by eq. (3.14) 


= linearized measurement matrix given by eq. (3.12). 


= 


Once the filter is initialized, we are ready to begin the data processing operation. 
The a priori state estimate and the state error covariance matrix are calculated using the 
@ matrix shown in equation (2.3) where T is the time difference in minutes between the 


observed lines-of-bearing. (It is assumed that the lines-of-bearing are received simul- 
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taneously by both sensors.) Once the projected state estimate has been calculated, it 1s 
used to calculate the linearized observation matnx in equation (3.12). 

The Kalman gain matrix serves to minimize the mean square estimation error and 
is an indication of how much emphasis or weight will be placed on the current observa- 
tion. If P,,-,, 1s small, the Kalman gain matrix will also be small due to the finite value 
of R,. If the Py, 1s relatively large, the gain is approximately one. By rewriting the 


equation for the calculation of the state estimate, equation (3.36) as 
A A 
X kik) = fale = Gell) Xriy—1) + Gyzp (3.38) 


we can see how the Kalman gain matrix directly affects the weight placed on the current 
observation z,. A large gain, indicating a large error covariance, will place more weight 
on the current observation as the filter tries to correct the states. A small gain, indicat- 
ing a small error covariance. places less emphasis on the new observation. 


If the Kalman gain 1s expressed as 
G,=P Hi Ry (Goo) 
k (k|k—1)44k !Sk 5.59) 


it can be seen that the gain matrix 1s “proportional” to the uncertainty in the estimate 
Pui) and “inversely proportional” to the measurement noise R,. Tor a large Rk, and a 
small P,,,.;,, the measurement noise (x) in equation (3.4) is due mainlv to noise and onlv 
small corrections should be made in the state estimate. However, if R, is small and 
Pu. 18 large. the measurement noise contains considerable information about the errors 


in the estimates and therefore a strong correction should be made to the state estimates. 
eer >: p. 127-8] 


E. MANEUVER AND DIVERGENCE DETECTION 

The extended Kalman filter used in the tracking scenario is defined as an adaptive 
or self-learning filter due to its ability to manipulate the process parameters (@,, H,, R,, 
and Q,) that change with time. If the model of the dynamic process under consideration 
is inaccurate, the filtered estimates tend to walk off from, or diverge from, the true esti- 
mates. As the filter locks on to the these inaccurate estimates, the state error covariance 
matrix gets very small which in turn causes the filter gain to decrease. When the filter 
gain decreases, less weight is placed on the current observations and the filter is unable 
to make the corrections required to correct the state estimates. The divergence problem 


can be detected by monitoring the filter residual process. 


The residual process of the extended Kalman filter is defined as the difference be- 
tween the observation at time /, and the output of the system model based on past inputs 
up to time z,. The residuals are a measure of how well the model fits the data. From 


equation (3.36), the residual process 1s 
A 
Ze — FX) p—1) (3.40) 


There are several techniques used to compensate for divergence. Bennett [Gia 
p. 14-16], observes the three most recent residual values using a moving average filter 
and computing the standard deviation of the residual process. It is determined that the 
target has maneuvered if the standard deviation exceeds a maneuver detection threshold 
value. The window of the moving average filter is wide enough to absorb excessive 
bearing errors that are far outside the standard deviation but narrow enough to detect 
a target maneuver soon after it occurs. This detection threshold was chosen to achieve 
a 90% probability of detecting a maneuver with a 10% false alarm rate. 

The maneuver and divergence technique implemented in this thesis is an adaptive 
noise esuumation technique presented by Jazwinski [Ref. &: pp. 311-315]. and utilized by 
Olcovich [Ref. 9: pp. 30-33]. This technique examines the residual of each observation 
and compares the residual value to an adaptive gate where the adaptive gate is defined 
as three times the predicted residual standard deviation. Defining the variance of the 
residual [Ref. 8: p.271] as 


ee orn. ee, (3.0 
The predicted residual standard deviation 1s 
0, = Cae SR ee (3.42) 
and the adaptive gate becomes 
GATE = 36, (3.43) 


For each observation, the residual is compared to the adaptive gate. If the residual 
value is less than the value of the adaptive gate, the filter continues on and processes the 
next observation. If the residual value is greater than the adaptive gate, the divergence 


detection and compensation algorithm begins. 
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The state excitation matrix, Q,, 1s increased by increasing the elements along the 
main diagonal of the OQ’, matrix given by equation (3.16). The old a priori value of the 
error covariance matrix. Py ,-), given by equation (3.34), is increased bv adding the new 
State excitation matrix to it. A new filter gain. G,, and a new predicted residual variance, 
Yur-ty » are then calculated using equations (3.35) and (3.41) respectively. By increasing 
QO, and adding it to P,,.;, We prevent the state error covariance from becoming overly 
optimistic while at the same time increasing the Kalman filter gain to appropriately 
weigh the current observations. The larger predicted residual variance increases the 
width of the adaptive gate and opens the filter window to a larger bearing deviation. If 
this bearing deviation exceeds the adaptive window for three consecutive iterations using 
the same observation, the filter determines that the target has maneuvered and the filter 
parameters are reset. 

Memoider tO efliciently implement this maneuver/divergence detection process, the 
value of Q, that is added to P,,.;.) must be carefully evaluated. If Q, is increased too 
much, Py, Will grow without bound resulting in a highly unstable filter. This value of 
QO, should be sufficiently high in order to open the adaptive gate wide enough to account 
for a random noisy bearing without indicating a target maneuver, and yet low enough 
so that a mancuvering bearing will be outside the filter window and the maneuver will 
be detected. A more sensitive filter. one with a narrow adaptive gate that would be ex- 
ceeded rather frequently by noisv bearings, will give a higher number of “false alarms” 
Or indications that the target has maneuvered when it actually has not. On the other 
hand, a less sensitive filter will tend to “miss” a target maneuver more often, due to the 
larger window of the adaptive gate. However, it will also provide fewer erroneous target 
maneuver indications. The idea is to design the adaptive gate parameters in order to 
optimize the number of actual target maneuver detections, to minimize the number of 
erroneous indications, and to prevent the filter from becoming unstable. 

For the ship tracking scenario, the state excitation matrix Q, was increased by in- 
creasing the coefficients along the main diagonal of the Q’, matrix by a factor of 2.5. 
These coefficients account for the random course and speed changes of the target. The 
multiplicative constant of 2.5, found by trial and error, increases the width of the adap- 
feneate by three percent for each iteration. 

The advantage of using this divergence algorithm over the moving average process 
used in Ref. 7, is that a target maneuver can be detected with one observation as op- 
posed to three observations required in the previous filtering algorithm. This advantage 


also poses a serious defect in that the divergence’maneuver detection decision is based 


i 


on only one residual and, therefore, has httle statistical significance. This can be cor- 


rected with the smoothing algorithm. [Ref. 8: p. 313] 


F. SMOOTHING ALGORITHM 

Smoothing is an off-hne procedure that uses all the state estimates produced by an 
estimator and attempts to improves the accuracy of these estimates by using more 
measurements to produce the smoothed estimate. The estimator used in this thesis is the 
extended Kalman filter described above. The basic idea behind smoothing is that for a 
time interval from 0 to k, an estimate at time k based on all previous estimates up to 
time K, (Xu), Will be more accurate than an estimate based only on the estimates up to 
lime Ag) 

Meditch [Ref. 10: p. 193] categorizes smoothing algorithms into three particular 
eroups. 

Fixed Point Smoothing smooths the estimate xy 9 at a fixed point & as K increases. 
Fixed Lag Smoothing smooths the estimate %y_y»x_ for a fixed delay .V as K increases. 
Fixed Interval Smoothing smooths the estimate xy) over the time interval from 0 to 
k where kK 1s fixed and & varies from 0 to k. 

This thesis uses a fixed-interval smoothing algorithm [Ref. 10: p. 216-224]. to 
smooth the state estimates of the extended Kalman filter in the ship and storm tracking 
scenarios. This smoothing routine provides the optimal state estimate at each time k 
over a fixed interval from 0 to K. The smoothing algorithm ts entered with the a priori 
and a posteriori estimates and their associated covariance matrices. The equations used 


in the smoothing algorithm are 


7a f 

Ap = Puy? Pusey (= 

XIN) = Xe) ar AglXueaiyny — x(k +1] k)) (3.45) 
a 

Pagay = Pade + APasipay — Pact iy) Ae (3.46) 


where 
A, = smoothing filter gain matrix 
Xu) = smoothed state estimate a time k based on N observations 


Paw = smoothed state cir or Couanance mati. 
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At the start of the smoothing routine. the last filtered estimate becomes the first 
smoothed estimate. The index & in equations (3.44-46) 1s decremented by one for each 
pass through the smoother with the beginning value of A equal to the number of data 
points to be smoothed, minus one ( .V—1 ). Consequently, the program makes \V— 1 


passes through the smoothing algorithm. 


1 


IV. COMPUTER SIMULATIONS 


A. GENERAL 

The SHIPTRACK extended Kalman filter program used in Ref. 7 was originally 
implemented on an Apple Macintosh Plus microcomputer. This program was modified 
and adapted to run on an IBM PC. A complete listing of the SHIPSM.FOR extended 
Kalman filter and fixed interval smoothing algorithm 1s included in Appendix A. The 
general scenario used in all of the computer simulation cases is that of two tracking ships 
moving in the general direction of the target ship. The track data required by 
SHIPSM.FOR for each scenario was generated using the program [Ref. 7] 
TRACKDATA.FOR. This program calls for the initial course, speed, and position of 
the two tracking ships and the target ship, the time of each HF DF interception, and any 
course and speed changes of the target. (The course and speed of the tracking ships is 
held constant throughout each simulation run.) The atmospheric noise 1s added to the 
observed HF DF line-of-bearing in the TRACKDATA.FOR routine. It generates an 
output file called TRAKDATA.DAT that contains the ttme of each observation, the po- 
sition of each tracking ship at each observation, and the angle of reception of each HF 
intercept. This is the input file for the filter and smoothing algorithm. SHIPSM.FOR 
generates four output files. FILDATA.DAT and SMIDATA.DAT contain the track in- 
formation and the files ELLIP.DAT and ELLIPS.DAT contain the data required to plot 
the error ellipses for the filtered and the smoothed positions respectively. The error el- 
lipses provide a graphical representation of the accuracy of the estimate. 

The error ellipses generated [Ref. 7: pp. 16-17] by the filter and smoothing algorithm 
represent an area where the probability of the target’s true position being within the el- 
lipse 1s 68%. The error ellipses are plotted for everv fourth position on the overall track 
plot for each scenario (if the ellipses are plotted for every point the plots become too 
cluttered to be interpreted accurately). A smoothed observation generates a smaller er- 
ror ellipse than the filtered estimate. This is due to the smaller error variances for the 
smoothed estimate compared to the error variances calculated for the filtered estimates 
and reflect the higher degree of confidence placed in the accuracy of the smoothed esti- 
mate. The last filtered estimate is equal to the first smoothed estimate and, therefore, 


the smoothed and filtered error ellipse for this point overlap. 


Graphical results were obtained using the Matlab graphics package and the plots 
included are representative of the results obtained from the different tracking scenarios. 
The first graph is a geographical plot that compares the observed track, or the raw data, 
with the filtered and smoothed track data and is used to demonstrate the effect of the 
Kalman filter and the smoothing algorithm on the noisy data. The following two graphs 
present the position errors and the variance in the x direction associated with the track 
data. The last plot is included to give the reader an idea of how accurate the filtered and 
the smoothed tracks are when compared to the target's true track. 

The computer simulations consisted of nine targeting scenarios as listed below. 

e Scenario #1--maneuver toward tracking ships, no measurement noise 

e Scenario #2--no maneuver, white noise model 

e Scenario #3--no maneuver, Hall noise model 

e Scenario #4--maneuver toward tracking ships, white noise model 

e Scenario #5--maneuver toward tracking ships, Hall noise model 

e Scenario #6--maneuver away from tracking ships, white noise model 

e Scenario #7--maneuver away from tracking ships, Hall noise model 

¢ Scenario #8--2 maneuvers awav from tracking slips, white noise model 


e Scenario #9--2 maneuvers away from tracking ships. Hall noise model 


Scenarios one thru seven were started with the target ship at a position of (-75,150). 
tracking ship #1 at a position of (-30,0), and tracking ship #2 at a position of (30,0). 
For scenarios eight and nine. the target ship started at the origin and the tracking ships 
were located at the above positions. The tracking ships were set on a course of 000° at 
10 knots for each scenario. The speed of the target ship was held constant at 15 knots 
throughout the simulations. The data was collected over a ten hour time frame with the 
HF intercepts recorded at 30 minute intervals for a total of 21] intercepts for each simu- 
lation. Al} times are given in minutes. 

The percent improvement in the position error due to the Kalman filter and the 
smoothing algorithm. is given for the different scenarios. This percentage was calculated 
by taking the percent of improvement, (+), for each observation and then averaging 
these percentages over the time interval of interest. These values give a relative indi- 
cation of the effectiveness or ineffectiveness of the filter and the smoother for a partic- 


ular scenario. 


B. SCENARIO #1 

The first tracking scenario was used to verify that the Kalman filter and the 
smoothing algorithm would accurately track a maneuvering target in a noiseless envi- 
ronment. The results for this scenario are shown tn Figures 5-8. In this case, the ob- 
served track equals the true track due to the absence of noise in the bearing 
measurements. The initial track error shown in Figure 6 1s due to the error in the initial 
state estimates. When the target maneuvers at 300 minutes, the tracking error increases 
dramatically for the first observation after the turn, however, it returns to zero two ob- 
servations later as the filter regains the target track. 

The error ellipses in Figure 8 demonstrate graphically how the accuracy of the po- 
sit1on estimates increases as the problem progresses. At time zero, the tracking ships 
are approximately 150 nm southeast of the target. The large distance in the y direction 
is reflected in the size and orientation of the major axis of the ellipse lvinguamee 
southeasterly direction. As the tracking ships move north, the magnitude of the major 
axis decreases and the direction of this axis rotates as the target ship passes in front of 
the advancing tracking ships and eventually to the east of at a range of approximately 


10 nm. At the end of the scenario, the tracking ships are located northeast of the target. 


to 
tu 


SHIP TRACKS (OBS-+, FILTER-o, SMOOTH-x,) 





200 
200 
z 
= 
= 
Y 150 
S 
oe 
Pp 
100 
00 
= 100 = 0 0 | 00 100 
X POSITION 
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Figure 7. Variance of Position Error in the X Direction 
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Figure 8. Scenario #1 Overall Track Results 


C. SCENARIO #2 

In this case, the target is steaming due east at 15 knots for the entire simulation. 
The results for this scenario are shown in Figures 9-12. The HIFDF hnes-of-bearing are 
distorted using a white noise model to represent the atmospheric noise. The observed 
track, calculated by taking the intercept of the unfilterd lines-of-bearing, 1s shown in 
Figure 9. From this plot and the error plot of Figure 10, we can see how the extended 
Kalman filter and the fixed interval smoothing improve the overall track estimate and 
decrease the position error. The Kalman filter improves the position accuracy by an 
average of 22% and the smoother improves the position accuracy by an average of 53%. 
The filtered target speed 1s 19 knots and the smoothed target speed is 14.8 knots. The 
increased confidence in the accuracy of the smoothed estimates is reflected in the plot 
of the error variance in the x direction. Figure 12 shows the relationship of filtered and 


smoothed tracks to the true target track. 
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Figure 9. Processed Data vs Observed Results 
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Figure 10. — Position Error 
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Figure 11. 9 Variance of Position Error in the X Direction 
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Figure 12. Scenario #2 Overall Track Results 


D. SCENARIO #3 

This scenario is the same as the previous one except that the white noise model 1s 
replaced by the Hall noise model. The results for this scenario are shown in Figures 
13-16. The effects of the impulsive characteristics of this noise model are evident in the 
early part of this simulation. A “wild” bearing, due to a noise spike, occurs at time 90 
resulting in a large position error. This causes the next three filtered estimates to be verv 
inaccurate, however, the filter does begin to correct its track two observations after the 
noise spike occurred. It 1s interesting to see that the smoother just about eliminates the 
large tracking errors due to the erratic behavior of the Kalman filter. During the time 
interval from 90 to 240 minutes, the average position error of the filtered estimates is 
more than 850% worse than the observed position error while the average smoothed 
position error 1s less than 130% of the observed error. Even with this improvement, the 
position error is stll greater than 20 nm and unacceptable for a long range missile at- 
tack. AAs the simulation progresses and the ships move toward each other, the track 
solution is refined and the track error remains inside of ten mules. The small noise spike 
at 570 minutes 1s completely smoothed by the smoothing algorithm. The average target 
speed estimated bv the filter is 20.3 knots and the smoother refines that estimate to 77 


knots. 
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Figure 13. Processed Data vs Observed Results 
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Figure I4. Position Error 
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Figure 15. Variance of Position Error in the X Direction 
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Figure 16. Scenario #3 Overall Track Results 
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E. SCENARIO #4 

In this simulation, the target makes a 60° course change toward the advancing 
tracking ships five hours after the problem starts. The results for this scenario are shown 
in Figures 17-20. The atmospheric noise model in this case 1s white noise. As in Sce- 
nario |, the initial error ellipses indicate the high degree of uncertainty in the position 
estimates, especially in the y direction where the range between the target ship and the 
tracking ships is the greatest. The average improvement in position error due to the 
filter for the entire simulation run was 24% and that due to the smoother was 28.5%. 
However, if we look at the first five hours of the problem, while the ships were still over 
100 miles away from each other, the improvement due to the filter was 44.5% and the 
smoother improved the position accuracy by over 62%. After the target maneuvered, 
the vessels closed each other at a speed of 23 Knots and the position error decreased 
rapidly. The Kalman filter tracked the target at an average speed of 16.5 Knots 


throughout the problem and the smoothed speed estimate was 14.8 Knots. 
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Fieure 17. Processed Data vs Observed Results 





TRACKING ERROR (OBS—+, FILTER-o, SMOOTH—x) 


n 
fx] 
= 
= 
— 
<{ 
< 
2 
= 
< 
ra 


MINUTES 





Fieure 18, Position Error 
39 ERROR VARIANCE IN X POSITION { 
290 | 


2007 


~ —-%-4-K--—% ——%K —_e 


Praeie e 
boi 


B A . 
_—X-——-—-A~ =F 2 PI 


100 Z00 300 400 000 


MINUTES 





Figure 19. 9 Variance of Position Error in the X Direction 
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Figure 20. = Scenario #4 Overall Track Results 
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F. SCENARIO #5 

The white noise model used in Scenario #4 1s replaced by the Hall noise model for 
Scenario #5. The results for this scenario are shown in Figures 21-24. In this case, three 
noise spikes occur at observations one, three, and four as seen in Figure 21 and, there- 
fore, the observed positions at these times are extremly inaccurate. The Kalman filter 
improved the position accuracy by 33% over these four observations while the im- 
provement due to smoothing the estimates was 59%. A fourth noise spike occurred 270 
munutes into the problem and although this was not as large as the first three spikes 
encountered, the filtered estimate 1s 46% better than the observed estimate andeume 
smoothed estimate is 78% better. Due to the relatively low amplitude of the Hall noise 
model outside of the noise spikes, the filtered and smoothed position estimates show 
only a nunor improvement in time frame from six to nine hours. The small noise spike 
at time 540 is pretty well smoothed out as seen in Figure 22. The average speed of the 
target estmated by the filter 1s 21 Knots and the speed estimated bv the smoother is 16.4 


Knots: 
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Figure 21. Processed Data vs Observed Results 
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Figure 22. — Position Error 
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Figure 23. 9 Variance of Position Error in the X Direction 
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Figure 24. Scenario #5 Overall Track Results 


4] 


G. SCENARIO #6 

This scenario depicts a 60° target maneuver to the northeast away from the two 
tracking ships heading due north. The results for this scenario are shown in Figures 
25-28. The white noise model 1s used in this simulation and because the relative distance 
between the ships remains between 100 and 150 nm throughout the problem, the ob- 
served position error remains on the order of 10-20 nm. This case demonstrates a gen- 
eral improvement in the filtered and smoothed estimates over the entire track. The 
position accuracy was increased by 25% with Kalman filter and by 45% using the fixed 
interval smoothing routine. The smoother kept the track error at or below 8 nm for the 
entire track interval with the exception of the first three observations to be smoothed 
at times 600, 570, and 540. The average speed estimates for the filter and the smoother 
Were 17.1 knots and 16.6 Knots respectively. Figure 28 shows the orientation of the 
major axis lving in the north-south direction where the distance between the ships 1s the 
largest. The magnitude of this axis is the largest at the beginning and the end of the 
problem and at a minimum when the target maneuvers and ships are the closest to- 


gether. 
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Figure 26. — Position Error 
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Figure 27, 9 Variance of Position Error in the X Direction 
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Figure 28. Scenario #6 Overall Track Results 
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H. SCENARIO #7 

In this case. the Hall model was used to model the atmospheric noise. The results 
for this scenario are shown in Figures 29-32. We can see three distinct noise spikes from 
the error plot in Figure 30 at 120, 330, and 510 minutes. For each of these tines 
filtered estimate is better than the observed estimate and the smoothed estimate is the 
most accurate of all. At other times, however, the filtered and smoothed estimate are 
not the most accurate and in fact are sometimes (180, 360, & 450) much worse than the 
observed error. The advantage to be gained by using the Kalman filter and the 
smoothing routine in a case like this is the elimination of large, non-predictable errors 
caused by the impulsive characteristics of atmospheric noise. The smoothed position 
error remains between 2-1] nm throughout the problem while the filter position error 
has a range of 2-28 nm and the observed position error varies from 3-38 nm. Figure 32 


shows the overall accuracy of the smoothed track compared to the target’s true track. 
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Figure 29. Processed Data vs Observed Results 
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Figure 30. — Position Error 
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Figure 31. Variance of Position Error in the X Direction 
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Figure 32. Scenario #7 Overall Track Results 


49 


I, SCENARIO #8 

This simulation uses the white noise model and includes two target maneuvers dur- 
ing the problem. The results for this scenario are shown in Figures 33-36. The target 
begins this scenario 150 nm due north and directly between the tracking ships on the y 
axis. The target’s initial course is 000° at 15 knots. At time 180 the target turns 
northwest to a new course 310° . At time 390 the target turns again to a new course 
040° . The tracking ships are heading due north at 10 knots. Due to the geometry of 
this scenario, the tracking routine 1s relatively accurate in the x direction with most of 
the position error in the y direction. The accuracy in the x direction is reflected in the 
sinal] variance error values shown in Figure 35. For the first five hours of the problem 
the improvement in the position accuracy due to the filter and the smoother was about 
the same (40%). During the second half of the problem, two large observation errors 
are detected. In both instances the filter and the smoother improve on the position ac- 
curacy, however, the because the observation error at 570 minutes is so large (140 nm), 
the position errors for the filtered estimates and consequently the smoothed estimates 
for the last two observations are also verv large. The effect of these large bearing errors 
is that the smoothed target track gives the impression that target has maneuvered and 
turned north when it actually has not. This can be seen in Figure 36. The size vomrne 
major axis of the error ellipses generated by the filtered and smoothed estimates also 
increases when the estimated distance of the target from the tracking ships increases to 
more than 220 nm by the end of the problem. The average target speed computed by 


the Kalman filter is 32.5 knots and the smoothed speed is 23.5 knots. 
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Figure 33. Processed Data vs Observed Results 
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Figure 34. — Position Error 


_-o- 0 = =, 
=" (a 

‘a 
> 


: ae 
é G a oye 


~ — 


300 
MINUTES 





Fieure 35. = Variance of Position Error in the X Direction 
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Figure 36. Scenario #8 Overall Track Results 


J. SCENARIO #9 

Scenario #9 duplicates Scenario #8 with the Hall model used to approximate the 
atmospheric noise. The results for this scenario are shown in Figures 37-40. Figure 38 
shows a large position error due to a noise spike 60 minutes into the problem. The fil- 
tered track for this scenario follows the target’s true track, however, the position errors 
vary from 4 to 28 nm over a ten hour tracking period. The smoother improves the po- 
sition accuracy of the tracker in this problem by an average of more than 60%. The 
smoothed track follows the target’s real track for the entire track period with no major 
deviations as shown in Figure 40. The average filtered speed is 25 knots and the aver- 


aged smoothed speed 1s 16.5 knots. 
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Figure 37. Processed Data vs Observed Results 
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Figure 38. — Position Error 
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Figure 39, Variance of Position Error in the X Direction 
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Figure 40. Scenario #9 Overall Track Results 
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V. STORM TRACKING 
A. GENERAL 


The storm tracking scenario parallels the ship tracking problem in that both prob- 
lems develop a position, course, and speed solution for a “target” with similar system 
dvnamics. Where the observations for the ship tracking problem were RDF lines-of- 
bearing that resulted in a nonlinear measurement equation (2.5), the observations for the 
storm tracking scenario are actual position coordinates given by latitude and longitude 
values. The storm tracks used in this thesis were obtained from data collected at the 
Joint Typhoon Warning Center located in Guam and run by the U.S. Navy and the U.S. 
Air Force. The position coordinates were obtained using aircraft, satellite, and radar 


reconnaissance assets. 


B. SYSTEM AND MEASUREMENT MODELS 


The tropical storms were modeled as linear, time distance systems where the state 


relationships are given bv 
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Where 4, 1§ a random forcing function with a covariance matrix given by the state 
excitation matrix. Q,. This is basically a fictitious noise source that prevents the error 


covariance matrix from becoming singular. Q, is defined as 
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The measurement model utilizes the linear measurement equation given by equation 
(2.6). Since the x and y position states are observed directly and given by the latitude 


and longitude position coordinates, the measurement equation can be written as 
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where the measurement noise v, has a variance of + 1 nm. 


C. STORM TRACKS 

Typhoon Pat developed east of Taiwan in the western Pacific on 24 August 1985. 
The Typhoon Warning Period for this storm was from 27 August until 1 September. 
Over this six-day period the storm traveled 1337 nm with maximum wind speeds of over 
95 knots. This storm caused significant damage in southwestern and northeastern 
Japan; primarily on the islands of Kyushu and Hokkaido. [Ref. 11: pp. 64-68] 

Figure 41 shows the actual track of Tvphoon Pat using the observed positions. The 
storm track shown in Figure 42 was constructed using the filtered and smoothed position 
estimates obtarned from the Kalman tracker. The observed storm positions are fairlv 
accurate and do not deviate from the overall track very much. Consequently, the filtered 
and smoothed storm positions do not show a great deal of improvement overall. In the 
areas of the track where the observed positions do vary, the smoother does improve the 
mereeaccuracy. specifically, these areas occur near 22° N, 126° E, and 37° N, 133° E. 

The second storm track analvzed was that of Tvphoon Tess that originated south- 
east of Guam on 30 August 1985. The warning period for this storm lasted from 1 
September until 6 September. Tess traveled 1470 nm over its’ seven-day lifespan on a 
track that took it over the Philippines. north of Luzon, and across the South China Sea 
moving mland 170 nm south of Hong Kong. Maximum wind speeds for this typhoon 
meresover 7/5 knots. [Ref. 11: pp. 76-77] 

The performance of the smoother on the track of Typhoon Tess was similar to that 
of Typhoon Pat. Figure 43 shows Tess’s overall track and Figure 44 shows the track 
results obtained with the Kalman filter and the smoothing algorithm. The Kalman 
tracker and the smoother show some improvement in the track accuracy in the area of 
fees 123° E and 18.5° N, 117° E. 

The application of the Kalman filter tracker to the storm tracking problem would 
be very useful in attempting to predict the storm’s track when all the position data is not 
available and the data that is available is not refined. Then, by using the filter and 
smoothing routine, a more accurate track of the storm’s past history can be calculated 


allowing for a more accurate prediction of the storm’s future track. 
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Figure 41. Storm Track of Typhoon Pat 
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Figure 42. ~~ Filtered and Smoothed Track of Typhoon Pat 
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VI. CONCLUSIONS 


The purpose of this research was to improve the accuracy and maneuver detection 
capability of an extended Kalman filter tracking routine by implementing a fixed interval 
smoothing algorithm and a maneuver/divergence detection method that uses a noise 
variance estimator process. The Hall atmospheric noise model was compared with a 
white noise model in estimating the effects of atmospheric noise on the received HFDF 
lines-of-bearing. Several different targeting scenarios were simulated and the accuracy 
of the observed. the filtered, and the smoothed target tracks were analyzed and com- 
pared. 

The fixed interval smoothing algorithm improved the position accuracy of the target 
in all the targeting scenarios simulated. Although the smoothed result was not always 
the most accurate for every observation, the smoother did improve the track accuracy 
by an average of 40-60 percent over the observed target positions and by an average of 
20-30 percent over the filtered estimates. The effectiveness of the smoother increased 
as the target range increased. The cost of this improvement was the increased computer 
time required to run the smoothing routine and for the simulations conducted, this in- 
crease Was on the order of approximately 60°%o or 6-7 seconds when the program was run 
on an [BNI PS 2 Model 60 micro-computer. 

The maneuver divergence detection scheme implemented worked well, however. be- 
cause this process involves the addition of a time varving value of the state excitation 
matrix, Q, to the a priori error covariance matrix, P,,_;. there 1s a strong potential for 
the filter to go unstable. This was observed when a verv large noise impulse was en- 
countered causing the observed line-of-bearing to change by more than 45° over one 
observation. The major advantage gained in using this maneuver detection process 1s 
that a maneuver 1s detected one observation after it occurs. 

A white noise model is a relatively accurate model of the atmospheric noise over an 
extended period of time, however, it fails to account for the impulsive nature of this 
noise process. The Hall noise model corrects for this deficiency and was used in several 
of the simulations. It was in the presence of these noise spikes that the operation of the 
smoother was at its best. In virtually all of the simulations conducted, the smoothing 
algorithm effectively eliminated the position errors due to a “wild” bearing caused by the 


impulse noise. The improvement in the position estimate due to the smoother was 
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commonly observed to be in the 75-85 percent range when a noise spike was encount- 
ered. 

There are several areas of this problem to be investigated further. The first area of 
Investigation involves the divergence detection algorithm. Although the process used in 
this thesis was able to detect a maneuver using one observation and accurately track a 
maneuvering target, there are many factors that must be modified to fit a particular 
noise environment and tracking scenario. These factors make this detection scheme 
undesirable if not impossible to implement in a real world, real time tracking problem. 
Another area for further research is adaptation of this tracking algorithm to a multiple 
target environment. This 1s an area where some work has been done and would be of 
great value in a ship tracking targeting scenario. In this type of problem, the ability to 
identify a high value target in a convoy or battlegroup is verv important as Well as the 
ability to identifv anv background shipping that is not to be attacked. The trend toward 
increased emphasis on passive tracking and targeting techniques will make this area of 


research highly mteresting and very useful in the future. 


65 


APPENDIX A. SHIPSM.FOR 


This is a listing of the SHIPSM.FOR program used to generate the data for the target 
tracks presented in this thesis. In order to run this program, the TRKDATA.DAT file 
must be available. This file is created by running the TRACK.FOR program located in 
Appendix B. 


CST Psi aor 


Crvdevedededtctckvodk TO RUN Sesieveskeokskotkskeclkestslesksksle 


C 

C 1) RUN TRACK 
C 2) RUN SHIPSM 
C 


Cree FOR GRAPHICAL OUTPUT *ieteix 


C 3) COPY ELLIP, ELLIPS ,FILDATA ,& SMDATA --> MATULARRSUR ie 

C 4) BEGIN MATLAB --> RUN SHIP 

C 

c sesevesedevoss dete ve sede de Fede Fee Tose RTE Tete TT ete Te Te Te eTe TOTES TCT TCT Te Ve ae a 0 eae aCe sas 1 a oe 2 Oe eee 

C THIS PROGRAM EMPLOYS AN ADAPTIVE EXTENDED KALMAN FILTER WITH a 

C FIXED INTERVAL SMOOTHING ALGORITHM TO TRACK A MANEUVERING SURFACE SHIP 

C TARGET USING BEARINGS-ONLY RADIO DIRECTION-FINDING MEASUREMENTS FROM 

C palhiag Riis ae SUNSORS. 

Co vevevevedevedevedosevevededevededed Aoi bk oir ok Li bar ok cari ik ir bie bikie) atk ie aio) seh sk ok ira arlyrlacisirireisriaricrisi tec eve 

C erVARIABLE DEFINITIONS*** 

C AK = SMOOTHING FILTER GAIN MATRIX 

C AKT = TRANSPOSE OF AK 

CG RG = MEASURED TARGET BEARING IN RADIANS 

C BRKKM1 = PREDICTED TARGET BEARING MEASUREMENT IN RADIANS 
E BRG( K]K-1) 

c DBRG = MEASURED TARGET BEARING IN DEGREES 

C DT = TIME DELAY BETWEEN OBSERVATIONS ,T(K) = TOkas 
C DTOR = DEGREE TO RADIAN CONVERSION FACTOR 

G De op = MEASUREMENT RESIDUAL, Z(K) - HCX(K|K-1)) 

C ea as op sia = MEASUREMENT RESIDUAL AT PREVIOUS OBSERVATION 
C JO aa eras = MEASUREMENT RESIDUAL TWO OBSERVATIONS PREVIOUS 
c FAC = RECIPROCAL OF VARE 

G G = KALMAN GAIN VECTOR 

C GATE = 3°**PREDICTED RESIDUAL STANDARD DEVIATION 

C H = MEASUREMENT MATRIX 

C HDG = ESTIMATED TARGET HEADING IN BEGREES 

c re oe TRANSPOSE OF H 

C I - COUNTER 

C IMAT = 4 X 4 IDENTITY MATRIX 

C os = COUNTER 

C K = ITERATION INGERVAE 

C LPR ~ STATE COVARIANCE MATRIX AFTER PREVIOUS OBSERVAT 
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C VARIABLE DECLARATIONS 

XKK(4,1) ,XKKM1(4,1),LPKKM1(4,4) , LXKKM1(4,1),PHI(4,4) 
H(1,4),G(4,1),TEMP1(1,4) ,TEMP2(1,1),TEMP3(4,1) 
TEMP4(4,4),TEMP5(4,4) ,PKK(4,4),PKKM1(4,4) ,HT(4, 1) 
LXKK(4,1),LPKK(4,4) ,XS(10) ,YS(10) ,DBRG( 10) ,BRG(10) 
TEMP6(4,4),PHIT(4,4),IMAT(4,4) ,TEMP7(4,4) ,XT,YT 
GATE( 2) ,VARE( 2) ,E(2) ,TEMP8(4,1),XE(1000) , YE( 1000) 
GATE1,GATE2 

DT, XDIFF, YDIFF, RANGE, XS1,YS1,BRG1, BRKKM1,Q(4,4) 
OBSERR(50) ,FAC1,SIGTH2 ,SIGVT2,R, ETOTAL, EAVG,RTOD 
X2,YS2,BRG2,2X,ZY,M1,E1,E1M1,E1M2,DTOR,TRKERR( 50) 

M2 ,E2,E2M1,E2M2,G11,G13,G21,G23,ZXM1,ZYM1,TEMP9(4, 2) 
XKKS(4,1,50),PKKS(4,4,50) ,SPD(50) ,SSPD(50) , PMMS(4,4,50) 
XNNM1(4,1),XSS(4,1),XKKM1S(4,1),XMMS(4,1,50) 
PNNM1(4,4),PSS(4,4),PKKM1S(4,4) , IPKKM1S(4,4) 
AK(4,4),AKT(4,4) ,11(4,4) , STRKERR(50) ,DTS(50) 
TEMP1S8(4,4) ,TEMP2S(4,1),TEMP3S(4,1) 
TEMP4S(4,4),TEMP5S(4,4) , TEMP6S(4,4) 


CotGe GG) Ci) ©) Corea ea C1 CoG C7 Gr Gd GG yO) CO Ga Ge) Ce ee rerum) Giguere CC) Cd 


LPKK™1 
LXKK 
LXKKM1 
ede ll 

Ja cll b 
ra 

PKK 
PKKS 
PKKM1 
PKKM1S 
TERR IS 
PSS 

Q 

R 
RANGE 
RTOD 
SPD 
PMP 


VARE 
eee 


XKK 
XKKS 
AKKM1 
XKAM1S 
XPOS 
XS 


REAL*4 
REAL*4 
REAL*4 
REAL*4 
REAL*4 
REAL*4 
REAL*4 
REAL*4 
REAL*4 
REAL*4 
REAL 4 
REAL*4 
REAL*¥4 
REAL*4 
REAL*4 
REAL*4 
REAL*4 


nub ud wd tt Won nb ad nb ou wd beau ea 


A PRIORI STATE COVARIANCE ESTIMATE 

STATE ESTIMATE AFTER PREVIOUS OBSERVATIONS 

A PRIORI STATE ESTIMATE 

DIS@REto- lit olAleE IkANSITION MATRIX 

TRANSPOSE OF PHI 

3. 141592654 

ESTIMATION ERROR COVARIANCE MATRIX, P(K|K) 

SMOOTHED ERROR COVARIANCE MATRIX 

PREDICTED ESTIMATION ERROR COVARIANCE MATRIX, P( 

PREDICTED ERROR COVARIANCE MATRIX FOR SMOOTHING, 

TNVERSESOE PREMIS 

ERROR COVARIANCE MATRIX FOR SMOOTHING, P(K{K) 

STATE EXCITATION MATRIX 

MEASUREMENT NOISE COVARIANCE 

DISTANCE FROM SENSOR TO A PRIORI TARGET POSITION 

RADIAN TO DEGREE CONVERSION FACTOR 

ESTIMATED TARGET SPEED IN KNOTS 

TEMPORARY STORAGE MATRICES USED IN MATRIX 
OPERATIONS 

VARIANCE OF RESIDUALS PROCESS 

DISTANCE IN X DIRECTION FROM SENSOR TO A PRIORI 

TARGET POSITION 

Eon MATER TARGET STATE VECTOR, X(K 

SMOOTHED TARGET STATE VECTOR 

PREDICTED TARGET STATE VECTOR, X(K|K-1) 

Peep iG thi TakGE STATE VECTOR FOR SMMOTHING, X(K 

BOLIMATED TARGET POSITION IN &% DIRECTION 

SENSOR POSITION IN X DIRECTION 

TARGET STATE VECTOR FOR SMOOTHING, X(K|K) 

TRUE TARGET POSITION IN X DIRECTION 

DISTANCE IN Y DPRECTION FROM SENSOR TO A PRIORI 

TARGET POSITION 

Polina EDS TARGET POSITION IN Y DIRECTION 

SENSOR POSITION IN Y DIRECTION 

TRUE TARGET POSITION IN Y DIRECTION 

OBSERVED POSITION IN X DIRECTION 

OBSERVED POSITION IN Y DIRECTION 





K) 
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REAL*4 XP(21),YP(21),XPS(21),YPS(21) 


INTEGER 220 Dobe TIME NE Glin 


G OPEN OUTPUT DATA FILES 


OPEN( UNIT=2 , FILE='TRKDATA. DAT‘ , STATUS=' OLD’ ) 
OPEN( UNIT=3, FILE='OUTDATA. DAT' ,STATUS=' NEW’ ) 
OPEN( UNIT=4 , FILE='TRUDATA. DAT' , STATUS='NEW' ) 
OPEN(UNIT=5 , FILE='FILDATA. DAT' , STATUS='NEW’ ) 
OPEN( UNIT=6, FILE='SMDATA. DAT' , STATUS='NEW' ) 
OPEN( UNIT=7 , FILE='ELLIP. DAT! , STATUS=' NEW' ) 
OPEN( UNIT=8 , FILE='ELLIPS. DAT , STATUS=" NEW" ) 
OPEN( UNIT=9 , FILE='RESULTS. DAT’ , STATUS='NEW' ) 
OPEN( UNIT=10 , FILE='RESIDU. DAT’ , STATUS=' NEW' ) 


C RADIAN/DEGREE CONVERSION FACTORS 


o>) 


e2 


Cae 


ee ee 


810 


POOL 


200 


oi antas eller 


RIOB=57 2957795 I 
DTOR=0. 01745293 


COMPUTE 4X4 IDENTITY MATRIX 


DO 5 t=1,4 
DG 5 eis 
IF (I.EQ.J) THEN 
IMAT(I,J)=1. 0 
ELSE 
THAR.) Ome 
ENDIF 
CONTINUE 


INITIALIZE TIME COUNTER 


TIMEM1=0 
Neat 
GTCTR=0 


COMPUTE BEARING MEASUREMENT COVARIANCE 


BEARING ERROR STANDARD DEVIATION = 3 DEGREES 
R=( 3*DTOR)***2 


ween se se ae we wel e em ms oem, 


- - ea Ns te ao en as a tae ead Oo, a te 9p an" ao neo on tes on, ont 1 nna watonlc ul alna we patneteelan se se welch eetee te eee at ataa!, 
AE hi get bar ik br ok bir hao hig kor fo ir eb Ford ici bok baie tix iairiieioetsroktrarrisvise ric leclsirivcl ise eee Sevevessescsese 


READ IN OBSERVATION PACKET (TIME, # OF SENSORS) 


DE=TTiEC Kye Tie CK 1} 


WRITE(*,*)'FILTERING TRACK DATA WITH KALMAN FILTER’ 

WRITE (+) *3====—44077 

READ(2,1001,END=800)TIME ,XT, YT ,XS( 1) (| YSCie Ere en 
KSC2).,YS( 2), DERG) 

FORMAT( 14, 8F9. 4) 


0) elo) ete 

IF (DBRG(L).GT. 180.0) DBRG(L)=DBRG(L)-360 
BRG( L)=DBRG(L)**DTOR 
CONTINUE 


IF (TIME: LT.0) Gore sce 
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DiIS=TivE=? IMEM1 
DTS(NP)=DT 


CAGEarINDPHI(PHI,DT) 


XS1=XS(1) 
YS1=YS(1) 
XS2=XS(2) 
YS2=YS(2) 
BRG1=BRG(1) 
BRG2=BRG( 2) 


CALL MP(XS1,YS1,XS2,YS2,BRG1, BRG2, ZX, ZY) 


IF( TIME. EQ. 0) THEN 
Goi UND i XSi, YS1)k52nus2. BRGI BRE2. XKK, PKK) 
C Wreed( 3") X(0|0,0)e— 
Dowco) 1=l,a 
ARR, P)=xkKC 1.1) 


C WRITE(3,*)XKK(I, 1) 

601 CONTINUE 

C WRITE(3,*)'P(0]0,0):' 

Deweoe I=1,4 

MO 602 J=1,4 
LPKK(1,J)=PKK(I,J) 

c WRITE(3,401)PKK(I,J) 

401 FORMAT(4F14. 4) 

602 CONTINUE 

ENDIF 


C PROJECT AHEAD STATE AND ERROR COVARIANCE ESTIMATES 





C X(K+1]K) = PHI * X(K{K) 
CALL MATMUL( PHI ,XKK,4,4,1,XKKM1) 

C Piece ee TIME. | {2 IMEM1,”,0)s 
Der Ces Mii 

C WRITE(3,*)XKKM1(I,1) 

Pl let eka 1 1) 
603 CONTINUE 
C P(K+1]K) = (PHI * P(K]K) * PHIT) + Q 


CALL MATRAN( PHI, PHIT,4,4) 
CALL MATMUL( PHI, PKK,4,4,4,TEMP6) 
CALL MATMUL(TEMP6 , PHIT,4,4,4, TEMP4) 
CALL GETQ(DT,XKKM1,Q,1) 
CALL MATADD(TEMP4,0,4,4,1,PKKM1) 
DO 408 I=1,4 
DO 408 J=1,4 
LPKKM1(1,J)=PKKM1(I,J) 
408 CONTINUE 
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402 
604 


204 


WRITE(3,*)'P(',TIME,']',TIMEM1,',0):' 
DO 398 I=1,4 
WRITE(3 ,*)(PKKM1(1,J),J=1,4) 


WRITEC3,*) QC ,TIME,' | , TIMEMI Ope 
DO 6Ocw I —ie 

WRITE(3 ,*)(Q(1,J) ,J=1,4) 
FORMAT(4F14. 4) 


DO 210 L=1,2 


C CALCULATE RANGE TO TARGET 


XD IFF=XKKM1(1,1)-XS(L) 
YDIFF=XKKM1(3,1)-YS(L) 
RANGE=SQRT( XDIFF**2+YDIFF**2 ) 


C UPDATE H MATRIX WITH LATEST STATE ESTIMATES 


H(1,1)=YDIFF/RANGE***2 
HG )=0n0 
H(1,3)=-XDIFF/RANGE** 2 
He) —040 

WRITE(3,*)'H MATRIX: ' 
WRITECS . OH( 1.1). [=154) 


C COMPUTE OBSERVATION RESIDUAL 


Cee) 6) 


cp 1a ap 


579 


BRKKM1=ATAN2(XDIFF, YDIFF) 

E( L)=BRG(L) -BRKKM1 

WRITE(3,*)'MEASURED BEARING = ‘ ,BRG(L) 

WRITE(3,**)' PREDICTED BEARING = ' ,BRKKM1 
WRITE(3,%)'BEARING RESIDUAL OF SENSOR ',L,' = ‘,E(L) 


COMPUTE VARIANCE OF RESIDUALS SEQUENCE 
AND ADAPTIVE GATE VALUE 
VARCE )=H**PKKM1**HT+R 


CALL MATRAN(H,HT,1,4) 

CALL MATMUL(H, PKKM1,1,4,4,TEMP1) 

CALL MATMUL(TEMP1,HT,1,4,1,TEMP2) 
VARE(L)=TEMP2(1,1)+R 

WRITE(3,%*) 'VARIANCE OF RESIDUALS = ',TIME,VARE(L) 
GATE(L)=3. 0**SQRT( VARE(L)) 


DO 7399 1-154 
WRITEC32 >) CPRRNIC 1 J) =) a 


C COMPUTE KALMAN GAIN MATRIX 


C 


G=PKKM1**HT*(H*PKKM1*HT+R )***-1 


CALL MATRAN(H,HT,1,4) 
CALL MATMUL( PKKM1,HT,4,4,1,TEMP3) 
WRITE(3,**)' PKKM1*“HT =' 
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414 


ons, 


C 
C 
C 


C 
418 
419 


415 
413 


C 
C 


406 
606 


DO 414 I=1,4 
Welle e,* )TEMP3( 1,1) 
CONTINUE 


FAC1=1/VARE(L) 
CALL MATSCL(FAC1,TEMP3,4,1,G) 


WRITE(3,*)'G =' 
DO 63: I=14 
WERIAECS5 9G] , 1) 


CONTINUE 


Poh Ou) THEN 


ELSE 


ENDIF 


Pieccl, 1) 
G13=G(3,1) 


G21=G(1,1) 
G23=G(3,1) 


COMPUTE UPDATED ERROR COVARIANCE MATRIX 


P(KIK) = (I - G*H) * P(K|K-1) 


CALL MATMUL(G,H,4,1,4,TEMP4) 

WRITE(3,*)'G*H =' 

omens: I=. 
WRITE(3,418)(TEMP4(1,J),J=1,4) 
FORMAT(4F14. 4) 

CONTINUE 


CALL MATSUB( IMAT,TEMP4,4,4,TEMPS ) 

WRITE(3,*) I-G*H =' 

Donic. 1=1.4 
WRITE(3,415)(TEMP5(1,J),J=1,4) 
FORMAT(4F14. 4) 

CONTINUE 

CALL MATMUL( TEMPS , PKKM1,4,4,4, PKK) 


PEC Sa) PC DIME | TINE, » ,i,'): ' 
DO 606 I=1,4 

WRITE(3 ,406)(PKK(1I,J),J=1,4) 
FORMAT(4F14. 4) 

CONTINUE 


C SAVE LATEST RESIDUALS & ADAPTIVE GATES 


900 


E1=E(1) 
E2=5(2) 
Cage =CATE( 1) 
GATE 2=GATE(2) 


WRITE(10,900)TIME,ABS(E1) ,ABS(E2),GATE1,GATE2 
FORMAT(14,4F10. 5) 


C COMPARE BEARING ERRORS TO MANEUVER DETECTION GATES 
Pee bece ci). Gl, (GATECIL)))) THEN 


GTCTR=GTCTR+1 


WRITE(*, +) ‘%* MANEUVER DETECTION GATE EXCEDED **' 
WRITE(* ,**) ‘TIME’ , TIME 


C WRITE(3,*) '** MANEUVER DETECTION GATE EXCEDED ***' 
C WRITE (322) eee 
CALL GETOCDT , XX 0) 
C CALL MATADD( PKKM1,Q,4,4,1,PKKM1) 
TP “CGIiCin: BOR) si 
GTCTR=0 


WRITE(*,%-) '%%%" MANEUVER DETECTION *%%' 
WRITE(*,*) ‘TIME’ , TIME 

C WRITE(3,%*) ‘2% MANEUVER DETECTION *%%*! 

e WRITE(3,*) TIME {TIME 
CALL REINIT(DT, ZX, ZY ,ZXM1, ZYM1 , LPKKM1 , XKKM1 , PKKM1) 
CALL GETOC DD, XK Ge, 


ELSE 
GOTO 204 
ENDIF 
ENDIF 
GTCTR=0 
C COMPUTE UPDATED ESTIMATE 
C X(K/K) = XCK|K-1) + G * E, WHERE E = Z(K) - H(K)*X(K|K-1) 
XKK( 1, 1)=XKKM1(1,1)+(GC1,1)*E(L)) 
NKK( 2, 1)=NKKM1(2,1)+(G(2,1)*E(L)) 
XKK(3,1)=XKKM1(3,1)+(€G(3,1)*ECL)) 
XKK(4, 1)=XKKM1(4,1)+(G(4,1)*E(L)) 
C WRITEC3,*)'XC*, TIME, |‘, DIMER ee 
DO 605 I=1,4 
C WRITE(3 ,** )XRRC@I4 1) 
605 CONTINUE 


C IF MORE MEASUREMENTS, 
[ee Ch LT 22) eS 
C USE UPDATED STATE AND ERROR COVARIANCE ESTIMATES 
e FOR NEXT MEASUREMENT 
DO 150 I=1,4 
DO 150 J=1,4 
PKKM1(I,J)=PKK(I,J) 
XKKM1(1,1)=XKK(I, 1) 
150 CONTINUE 
ENDIF 
210 CONTINUE 


C THESE STATEMENTS ARE FOR THE SMOOTHING ALGORITHM 


DO 620 I=1,4 
XKKS(I,1,NP)=XKK(I,1) 


620 CONTINUE 
DO 630 I=1,4 
DO 630 J=1,4 
PERS(C 14 NE )=PRR GL) 
630 CONTINUE 
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C COMPUTE TRUE TRACKING AND OBSERVATION ERRORS 
iene Ohl (XT-xXKK( 1, 1) j*2+(YT-XKK(3, 1) )**2) 
OBSERR(NP)=SQRT( (XT -2X)**2+( YT-ZY )***2) 


C COMPUTE ERROR ELLIPSE DATA 
Oeigimeemeee Ahh ( 1S) XKK(3,1),PKK(1,1),PKK(3,3),PKK(1,3),XP,YP) 
DO 640 I[E=1,21 
i irere + )XPC IE) ,YPCIE) 
640 CONTINUE 


C COMPUTE ESTIMATED X-Y POSITION, COURSE, AND SPEED 
XPOS=XKK( 1,1) 
YPOS=XKK( 3, 1) 
IF (XKK(2,1).EQ.0 . AND. XKK(4,1).EQ.0) THEN 
HDG=0. 0 
ELSE 
HDG=RTOD**ATAN2( XKK(2,1),XKK(4,1)) 
ENDIF 
IF (HDG. LT. 0.0) HDG=HDG+360 
SPD(NP)=60*SQRT( XKK( 2, 1)**2+XKK(4, 1)%**2) 


C WRITE(*,*)' FILTERED DATA FOR DATA POINT' ,NP 
WRITE(3,*)' FILTERED DATA FOR DATA POINT' ,NP 

C WRITE(*,*) ‘TIME X POS Y POS HEADING SPEED’ 
WRITE(3,*) ‘TIME X POS Y POS HEADING SPEED’ 

C Wetee@~., 1002)TIME,XPOS,YPOS,HDG,SPD(1) 


WRITE(3,1002)TIME,XPOS,YPOS,HDG,SPD(I) 

WRITE(4,1003)TIME,XT,YT 

WRITE(5,1004)TIME,NP,XPOS,YPOS, ZX, ZY, TRKERR(NP) , OBSERR(NP), 
z: PKK(1,1),PRKO3,3),XT, YT 


6 WRITE(5 ,**) TIME ,XT, YT, XPOS, YPOS, 2X, ZY, LXKKM1(1,1), LXKKM1(3,1), 
oo = ABS(M1) ,GATE1(1),ABS(M2) ,GATE1(2), 
ae Gill G13.G2le2> TRKERR OBSERR 


1002 FORMAT(14,8F8. 1,8F8.5,2F8. 1) 
1003 FORMAT(14,2F8. 1) 

1004 FORMAT(214,10F8. 1) 

1005 FORMAT( 14,4F8. 1) 


C UPDATE DATA COUNTER 
NP=NP+1 
TIMEMI ST IME 


ZXM1=ZxX 
ZYM1=ZY 


GOTO 810 


800 NP=NP-1 | 

C THIS IS WHERE THE SMOOTHING ALGORITHM STARTS 

C FIXED INTERVAL SMOOTHING 
WRITE(*,*)'SMOOTHING FILTERED DATA WITH A' 
WRITE(*,**)'FIXED INTERVAL SMOOTHING ALGORITHM' 
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WRITE( #532 eee == ae 
C WRITE(* , **) | eeeestererees SMOOTHING STARTS HERE *iesecededed' 
WRITE( 3, %) | ose’ SMOOTHING STARTS HERE teedededededs | 


DO 1000 KK=1,NP-1 
K=NP-KK 


DT=DTS(K+1) 


TIME=TIMEM1I-DT 
CALL FINDPHI(PHI,DT) 


DO 901 I=1,4 
RSC], DSxKhS ei) 
901 CONTINUE 


DO 902 I=1,4 
DO 902 J=1,4 
PSS(1I,J)=PKKS(1I,J,K) 
902 CONTINUE 


C CALCULATE THE PREDICTED STATE AND ERROR COVARIANCE MATRICES 
C X(K+1|K)=PHI*X(K[K) 

CALL MATMUL (PHI,XSS,4,4,1,XKKM1S) 
E P(K+1|K)=PHI*P(K|K)**PHIT+Q 

CALL MATRAN (PHI, PHIT,4,4) 

CALL MATMUL(PHI,PSS,4,4,4,TEMP6) 

CALL MATMUL(TEMP6 , PHIT,4,4,4,TEMP4) 

CALL GETOQ(DT,XKKM1S,Q,1) 

CALL MATADD(TEMP4,Q,4,4,1,PKKM1S) 


C CALCULATE THE SMOOTHING FILTER GAIN MATRIX 
C AK=P(K|K)*PHIT*INV°P( K+1{K) 
CALL MATINV CPKKM1S,4, IPKKM1S) 
CALL MATMUL: CPRKMIS ,IPKKMIS,4 234m) 
CALL MATMUL (PSS,PHIT,4,4,4,TEMP1S) 
CALL MATMUL (TEMP1S, IPKKM1S,4,4,4,AK) 


DO 904 I=1,4 
XNNM1(1,1)=XKKS(I,1,K+1) 
904 CONTINUE 


C CALCULATE THE SMOOTHED STATE ESTIMATE 

C  XKKS=X(K[K)+AK*(X(K+1]N)-X(K+11K) 
CALL MATSUB (XNNM1,XKKM1S,4,1,TEMP2S) 
CALL MATMUL (AK,TEMP2S,4,4,1,TEMP3S) 
CALL MATADD (XSS,TEMP3S,4,1,K,XKKS) 


DO 906 I=1,4 
DO 906 J=1,4 
PNNM1(1,J)=PKKS(1I,J,K+1) 
906 CONTINUE 


C CALCULATE THE SMOOTHED COVARIANCE MATRIX 
E PKKS=P(K|K)+AK**[ P(K+1|N)-P(K+1[K)] “ART 
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CALL MATSUB (PNNM1,PKKM1S,4,4,TEMP4S) 
CALL MATRAN (AK,AKT,4,4) 

CALL MATMUL (AK,TEMP4S,4,4,4,TEMP5S) 

CALL MATMUL (TEMP5S,AKT,4,4,4, TEMP6S) 
CALL MATADD (PSS,TEMP6S,4,4,K, PKKS) 


PeeomeUlh ESTiMaTED X-Y POSITION, COUKSE, AND SPEED 
SXPOS=XKKS(1,1,K) 
SYPOS=XKKS(3,1,K) 
Ieee tot, 1, Kk). EQ.0 . AND. XKKS¢@4)1,K).EQ.0) THEN 
SHDG=0. 0 
lige e. 
SHDG=RTOD*ATAN2( XKKS(2,1,K),XKKS(4,1,K)) 
END 
IF (SHDG. LT. 0.0) SHDG=SHDG+360 
SSPUCK)=60"SQORTCXKKS( 2,1,K)**2+XKKS(4,1,K)**2) 


e WRITE(*,*)' SMOOTHED DATA FOR DATA POINT' ,K 
WRITE(3,*)' SMOOTHED DATA FOR DATA POINT' ,K 

c WRITE(*,*)'TIME X POS Y POS HEADING SPEED' 
WRITE(3,*)'TIME X POS Y¥ POS HEADING SPEED’ 

e WRITE(*,1010)TIME,SXPOS,SYPOS ,SHDG,SSPD(K) 
WRITE(3,1010)TIME,SXPOS ,SYPOS,SHDG,SSPD(K) 

e Pie @ee 1 020 NP, KKKNS( 11 | K), XKKS(3,1,K),PKKS(1,1,K) 

1010 FORMAT( 14, 8F8.1,8F8.5,2F8. 1) 

1020 FORMAT( 214,3F8. 1) 


Pee iS ie 
1000 CONTINUE 


REWIND 4 


C CALCULATE THE SMOOTHED TRACKING ERROR 
WRITE(9,*)'ERROR DATA FOR DATA POINT TRACKING ROUTINE’ 
WRITE(9,*)'K  OBSERR TRKERR STRKERR FILSPD SMSPD' 
DO 1100 K=1,NP 
SXPOS=XKKS(1,1,K) 
SYPOS=XKKS(3,1,K) 
READ(4,1110)TIME ,XT,YT 
STRKERR( K)=SORT( (XT-XKKS(1,1,K) )%*2+( YT-XKKS( 3, 1,K))**2) 
C COMPUTE ERROR ELLIPSE DATA 
Pomme mieneG cKKS(1,1.K), XKKS(3,1,K), 
ve PKKS(1,1,K),PKKS(3,3,K), PKKS(1,3,K),XPS,YPS) 
DO 1050 IE=1,21 
WRITE(8,*)XPS(IE),YPS(IE) 
1050 CONTINUE 
WRITE(6,1120)K,SXPOS,SYPOS , STRKERR(K), 
vs PKKS(1,1,K),PKKS(3,3,K) 
WRITE(9,1130)K,OBSERR(K) , TRKERR(K) , STRKERR(K) , SPD(K) , SSPD(K) 
1100 CONTINUE 
1110  FORMAT(14,2F8. 1) 
1120 FORMAT(14,5F8. 1) 
1130 FORMAT(14,5F8. 1) 


CLOSE( UNIT=2) 


CLOSE( UNIT=3) 
CLOSE( UNIT=4) 


is 


CLOSE(UNIT=5) 
CLOSE(UNIT=6) 
CLOSE(UNIT=7) 
CLOSE( UNIT=8) 
CLOSE( UNIT=9) 
CLOSE( UNIT=10) 


WRITE(*,*)'FILTERED & SMOOTHED OUTPUT DATA IS LOCATED IN THE’ 
WRITE(*,*)'DATA FILE OUTDATA. DAT. FOR GRAPHIC RESULTS COPY’ 
WRITE(*,*)’ 1) ELLIP. DAT' 

WRITE(*,*)' 2) ELLIPS. DAT' 

WRITE(*,*)' 3) FILDATA. DAT’ 

WRITE(*,*)' 4) SMDATA. DAT' 

WRITE(*,*) ’ 5) TRUDATA. DAT' 

WRITE(* ,*) ' TO THE MATLAB SUB-DIRECTORY AND RUN ==>SHIP.M.' 
WRITE(*,*)'THERE WERE',NP,' |§ OBSERVATIONS PROCESSED. ' 

STOP 

END 


Crsvidevedssedevedtvedede seseveseslevelevedesicvevcdevevesedesdevevevevedescveseveselcdeedkvkededcdededkvedkdesveslekevovedcdeslede sede 


C isc acest area 


C Sedesevccevesovededssidevedvedeletcdeledescscdolidleolctsiclisdeleaededetek tevetkdkdededesetesedodedededededededededededvededs 


oP Ne ed a eee ees 
CC veveskvedess riorierirlor seacbr rn otis srs rh crease 
C COMPUTES THE VALUES OF THE PHI Reiss 


REAL" ~ PHIC4, hy. Dr 


DO 1501 t= 
DO 1501 J=1,4 
DO 1501 K=1,2 
PHI(I,J)=0. 0 
1501 CONTINUE 


C COMPUTE PHI MATRIX 
DO 1500 I=1,4 
PHI(I,I)=1.0 
1500 CONTINUE 
PHI(1,2)=DT 
PHI(3,4)=DI 


RETURN 


END 


ieee INITOXSis Ys lj XS2 5 oer ones BRG2, XKK, PKK) 


@ we ste! <ve s's eulonlente ews sles eve es'e estenteete sles'es'e eve oY evlestesles's se evewe eon * Pe eats a Je ‘eve Re 


C THIS ROULINE, ENEDTTALI ZESeene STATE 
C fab: oa Raed cea Cee oe 
CC owsvedsdedtesss oars mid oriie wurtiioridrinriyririeciecte 


REAL*4 XKK(4,1), PRK(4, 4) 
REAL*4 XS1,YS1,XS2,YS2,BRG1, BRG2 
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REAL*4 NUMER , DENOM 


C INITIAL STATE ESTIMATE 


NUMER=( -YS2*TAN( BRG2) )+( YS1*TAN( BRG1 ) )+XS2-XS1 
DENOM=TAN( BRG1) -TAN( BRG2) 


XKK(3,1)=NUMER/DENOM 

XKK(2,1)=0.0 

XKK(1, 1)=(XKK(3,1)-YS1)*TAN( BRG1)+XS1 
XKK(4,1)=0. 0 


C INITIAL ERROR COVARIANCE ESTIMATE 


CG OSelde erie Teer 


C 
C 


Wen eeeuey eo 


100 


PKK(1,1)=10000 
PKK(1,2)=0. 0 
PKK(1,3)=0.0 
PKK(1,4)=0. 0 
PKK(2,1)=0. 0 
PkR( 2? ,2)=0. 2500 
PKK(2,3)=0. 0 

PKK(2,4)=0. 0 

PKK(3,1)=0. 0 

PKK(3,2)=0. 0 

PKK(3,3)=10000 
PKK(3,4)=0. 0 
PKK(4,1)=0.0 
PKK(4,2)=0. 0 
PKK(4,3)=0. 0 
PKK(4,4)=0. 2 


=0. 
Q. 
0. 
82 
0. 2500 
RETURN 
END 


ee eee Bee Q, ese 
558% eS nie ester bel vich bak oer te tees 
ROUTINE TO CET 0 MATRIX WHERE 
2 = me ie oe baie 


alone ae Sevesevesesleslccleslcclontes'eclenloclenlon'ac'en'an! 
wah 


“REAL” fh DT UXKEM1(4, ‘1, O04, 4 
REAL*4 QPR(2,2), GAMA(4, 2 GAMAT( 2,4) 
REAL*4 SG 2, SictH2, VT 


Sededevelosdlededesesedesiesesedesevedevesicdesvseseve 


INTEGER FLAG 


IF ((XKKM1(2,1).EQ. 0). OR. (XKKM1(4,1).EQ.0)) THEN 
DO 100 I=1,4 
DO 100 J=1,4 
Q(1,J)=0. 0 
GOTO 200 
ENDIF 


C CALCULATE Q'MATRIX ’ 


S1GVI2=0. 0001 
SIGTH2=0. 01096 
VT=SQRT( XKKM1( 2, 1)2**24+XKKM1(4, 1) #2) 


a 


QPR(1,1)=(( (XKKM1(2, 1) /VT)**2)*SIGVT2)+( (XKKM1(4, 1)**2)*SIGTH2) 
QPR(2,2)=(((XKKM1(4, 1) /VT)%*2)*SIGVT2 )+( (XKKM1( 2, 1)*%2)*SIGTH2) 
QPR(1,2)=( (XKKM1(2,1))*(XKKM1(4,1))/(VT"*2) )*SIGVT2 
-(XKKM1(2, 1) )*(XKKM1(4, 1) )*SIGTH2 

QPRC2, =O Ga) 
IF (FLAG. EQ. 0) THEN 

QPR(1,1)=2. 50*QPR(1,1) 

QPR(2,2)=2. 50*QPR(2,2) 
ENDIF 


C CALCULATE GAMA MATRIX 


GAMA(1,1)=(DT""*2)/2.0 
GAMA(2,1)=DT 
GAMA(3,1)=0. 0 
GAMA(4,1)=0. 0 
GAMA(1,2)=0. 0 
GAMA(2,2)=0. 0 
CAMAC3 2) cna 2 2) 
GAMA(4,2)=DT 


C Q=GAMA(K)*Q'(K)*GAMAT(K) 


200 


7G a 


CALL MATRAN(GAMA,GAMAT,4,2) 

CALL MATMUL(GAMA,QPR,4,2,2,TEMP9) 
CALL MATMUL(TEMP9 ,GAMAT,4,2,4,Q) 
CALL MATSCL(0. 01,0,4,4,Q) 


RETURN 


END 


SUBROUTINE Sera ee aS ay, ee Zt, Be Wc ee. 


( eepel loa al Ure Some 


THIS ROUTINE RE- INITIALIZES THE STATE AND ERROR 


COVARIANCE ee 


2 Peete Saw awe wee we soso’ seco se’, vles'ectee eae 20's a‘es'es'e <2 slesle Seve ve sleclecle lesloslodesloceslesledeslesledesesleslovesevs 
as = Saris ey ENR GR ER AN FRO FR GX FV EN CU FL FN GO FM ED FB ER CRN EX EX GL FR ER EN 


DT, XEEMI(A, 1, PKEMIC4., 4) 
Myay ,Z5i1,Z2YM1, LPRKKM VG 


9) 
to 
> i 
e 
hae 


XDIFF=ZX-ZXM1 

YDIFF=ZY-ZYM1 

IF (DT.EO.0) THEN 
XKKM1(1,1)=ZX 
XERM1(2.1)=XDIFF 
XKKM1(3,1)=ZY 
XKKM1(4,1)=YDIFF 

ELSE 
MKKN1C 12 1)=2% 
KER? =< DIbe pr 
Sicha a a 
XKKM1(4,1)=YDIFF/DT 

ENDIF 


WRITE(3,*) ‘REINITIALIZED STATES ARE: ' 
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100 


CaCI ea 


(eter eal ee re oe 


DO 100 I=1,4 
WRITEC3,* )XKKMICI, 1) 
CONTINUE 


PKKM1(1,1)=LPKKM1(1,1) 
PKKM1(1,2)=0. 0 
PKKM1(1,3)=LPKKM1(1,3) 
PKKM1(1,4)=0. 0 
PKKM1(2,1)=0. 0 
PKKM1(2,2)=0. 1111 
PKKM1(2,3)=0. 0 
PKKM1(2,4)=0. 0 
PKKM1(3, 1)=LPKKM1(3,1) 
PKKM1(3,2)=0.0 
PKKM1(3,3)=LPKKM1(3,3) 
PKKM1(3,4)=0. 0 
PKKM1(4,1)=0. 0 
PKKM1(4,2)=0. 0 
PKKM1(4,3)=0. 0 
PKKM1(4,4)=0. 1111 


RETURN 
END 


SUBROUTINE MP(XS1,YS1,XS2,YS2, BRG1, BRG2, 2X, ZY) 
Seive iris clatter aed tary SpE een ri rey RnR Easel \ie ror (arial sey eto Voriar) 3 
THIS ROUTINE COMPU S. £heE ESTIMATED 
=s pas Lae one rea oe Ea eaenares 
oa ra ek irl skiers cl cay ec arise se cae ee ae ore or tea te eke oie oot) els 
REALS 2x “WY 
REAL*4 XS] MOS Noce oe. bho, SRG 
REAL*4 NUMER , DENOM 


See 2TIAL STATE ESTIMATE 


CasG7' 2) €2"C) 


ee aa ee ese 


NUMER=( -YS2*TAN( BRG2) )+CYS1*TAN( BRG1) )+XS2-XS1 
DENOM=TAN( BRG1) -TAN( BRG2) 


ZY=NUMER/DENOM 
ZX=(ZY-YS1)*TAN( BRG1)+XS1 


RETURN 


END 


Ee Pte ee Nae i nee LS) FG arte og 


weatenten! Ses'esfevles'ss'e ee oe Sete hak ota eae este 
eae alee’, € c 


THIS SUBROUTINE COMPUTES ERROR ELLIPSE DATA 
eveves toute steele ele se esos! s'e edeve vedeveves' teve sevice 


“DIMENSIONS AND DECLARATIONS 

REAL*4 XT,YT,XP(21),YP(21),4,B,THE1,SIG2X,SIG2Y 
BEd 4 6X. SY.PT,CT,ST,P1,P16.P3 

INTEGER**2 NP 
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10 


100 


Reheeoe Ne ee eee ie a ae i ae 


ae o> Tl a Ea ok, 


10 


100 


DIMENSIONS “AND. DECLARATIONS 


DIMENSIONS AND DECLARATIONS 


A=2*P13 

B=P1-P3 

THE 1=0. 5*ATAN2(A,B) 
A=(P1+P3)/2 

B=0.0 

IF (P13.EQ.0.0) GOTO 10 
B=P13/SIN(2. O*THE1) 
SIG2X=ABS( A+B) 
SIG2Y=ABS(A-B) 
SX=SIG2X""0. 5 
SY=SIG2Y*"*0. 5 

PT=3. 141592654/10 
CT=COS(THE1) 
ST=SIN(THE1) 


DO 100 Beat 
APC IE)=SX*COS( PT*1IE)*CT-SY*SIN( PI-TE sim 
YPCIE)=SX*COS( PT* IE )*ST+SY*S INC PI* IE )*CT+YT 
CONTINUE 
RELUKS 


END 


“THIS ROUTINE MULTIPLIES TKO MATRICES TOGETHER. 
: Pacer ore = ae ae oe ee 


‘ee ae outan” on eoe 


REAL*4 ACL,M),BCM,N),CCL,N) 


DO 10 I=1,L 

DO 10 J=1,N 
Cet) 000 

CONTINUE 


DO 100 I= 1,L 
DO 100 J= 1,N 
DO 100 K= 1,M 
C(I,J) = C(I,J) + ACI,K)*B(K,J) 
CONTINUE 


RETURN 


END 


pies eh aS 8, 2 ay) 


clestecte onte reser slerlovedesloslece 
#e 


THIS ROUTINE TRANSPOSES A MATRIX 
: BUM, N) = iat Aor 2M) 


REAL*4 A(N,M), BC(M,N) 
DO 100 I= 1,N 
DO 100 J= 1,M 
Bef) = ACI,J) 
100 CONTINUE 
RETURN 


END 


ec es Bee eee A,N,M »C) 


CG tededededededodedededede cede de sede ese ved He ve 7e ee Leis ie rise rire Gtr eter ise sr oe keris har bee) tr ksh cis 
& Tats ROUTINE MULTIPLIES A MATRIX WITH A SCALAR 
& "TEC M) = oO * aan M) 
GC dedededededededevede de deve dete Tete dete tele de ee Fede Te TENE TE TENE TE TENE VETER TCT TENCE TEER REE IC 
C DIMENSIONS AND DECLARATIONS 
REAL*4 A(N,M), CCN,M), Q 
DO 100 I = 1,N 
HOSt00 J = 15M 
mele = o-A(1.J) 

100 CONTINUE 

RETURN 

END 


pee ee ees Ba tie C) 
SRusaees eens ees cies avigtise ris Sri age icoTic nis or srt brciniciy keris 
THIS ROUTINE SUBTRACTS T¥O MATRICES 
: EON iM) = = ACN, SM) - RAGE 1M) 
- 6a bes ty Nobis isi tak Carle wor Wor ic ae cae Lg 
DIMENSIONS AND DECLARATIONS 
REAL*4 A(N,M),BC(N,M),CCN,M) 


C2 .G2-Ca Cac? 


Do T0051 ery 
Pee oo = 1M 
Cui =A lL, Spe Bel) 
100 CONTINUE 


RETURN 
END 


pee ee B Ns iM, ec) 
eee sess 3e cee SiGe hy tier Jeveve bee OS risriel iris arokise ict 
THIS ROUTINE ADDS Two MATRICES 
; C(N,M) = ACN, Ye BCN, M) 
slesesleslesteslesles'es'e e's s'es'e s'e 5": eve steve sieste slestertests sevfestes s'e ste esie 
DIMENSIONS. "AND DECLARATIONS 
REAL*4 A(N,M),BC(N,M),C(N,M,L) 
BO 100 I its) 
DO 100 J = 1,M 


HM ott 


8] 


CG1,J, L)=aAC iss) 
100 CONTINUE 


RETURN 
END 


SUBROUTINE MATINV (A,N,C) 
Cress dene dover ede te sere ts Tee sete Fe ae Tee Te Ve Te TIES IE SE TE TE TE IC TE Te TE Te ETE IE Te Ie NE EI I 
C THIS ROUTINE COMPUTES THE INVERsee es 
C A MATRIX 
C C(N,N)=INV [ ACN,N)] 
Crevededcdsclede de de de csas voce sede cede ce ds tele te eae Fe eas Fo Fee eM Te Ns ee ts Te Ie He Ie Te eI 
C DIMENSIONS AND DECLARATIONS 

REAL*4 ACN,N), oe ND DC 205.20) 

DO. 100.1 = 1. 

DO 1007us= 1 os 

100 D(I,J)=A(1,J) 


DO 115 I=1,N 
DO 115 J=N+1,2*N 
115 Dre) =0n0 


DO 120 I=1,N 
J=I4N 
120 D(I,J)=1. 0 


DO 240 K=1,N 
M=K+1 
IF (K.EQ.N) GOTO 180 
L=K 
DO 140 I=M,N 
140 IF (ABS(D(1I,K)). GT. ABS(D(L,K))) L=I 
IF (L.EQ.K) GOTO 180 


DO 160 J=K,2*N 
TEMP=D(K, J) 
DCK,J)=DCL,J) 


160 DU Jj =Teer 
180 DO 185 J=M,2*N 
Khe) Dek UC DCRR) 


[PUCK EO. 1) CORO. 270 
M1=K-1 
DO 200 I=1,M1 
DO 200 J=M,2*N 
200 DCT, J)=D( 1,3 PCr re DOK 


LP GR eEOR ss CU lOmz2 50 


220 DO 240 I=M,N 

DO 240 J=M,2*N 
240 DO1 J) =DU1 J) -o 
260 DO 265 I=1,N 





APPENDIX B. TRACK.FOR 


This is the TRACK.FOR program used to generate the TRADATA.DAT file to be 
read by SHIPSM.FOR. This program was written by ei Women cance 


REAL*4 XT(4,1),XS104,1),PHI(4,4),SPDS1,HDGS1,SPDS2 ones 
REAL*4 DT,SPDT,HDGT,XS2(4,1),TEMP1(4,1),CASE,XDIFF1,YDIFF1 
REAL"4 XDIFF2,YDIFF2,N1,N2,DTOR,RTOD,BRG1,BRG2 

INTEGER TIME, TIMEM1 


OPEN( UNIT=2 ,FILE='NOISE1. DAT’ , STATUS='OLD' ) 
OPEN(UNIT=3 ,FILE='NOISE2. DAT’ ,STATUS— Oln 9 
OPEN( UNIT=4 , FILE='TRKDATA. DAT’ , STATUS=' NEW' ) 


WRITE(**,**) ‘ENTER A NEGATIVE NUMBER FOR NOISELESS CASE; ' 
WRITE(*,*)'POSITIVE FOR NOISY CASE’ 
READ(* ,**) CASE 


TIMEM1=0 
RICH =57.. 29577951 
DTOR=0. 017453293 


WRITE(*,*)' INPUT DESIRED INITIAL X POSITION OF TARGET' 
READE = cE lek) 

WRITE(*,*)' INPUT DESIRED INITIAL Y POSITION OF TARGET' 
READ(*,*)XT( 3,1) 

WRITE(*,**)' INPUT DESIRED TARGET SPEED IN KNOTS' 
READ(*,**)SPDT 

WRITE(*,**)' INPUT DESIRED TARGET COURSE IN DEGREES’ 
READ(* , ** )HDGT 


ATC 2,1)=(SPDT/60)*SINC HDGT*DTOR) 
XT(4, 1)=(SPDT/60)*COS( HDGT*DTOR ) 


WRITE(*,*)'FOR SENSOR 1: ' 

WRITE(*,**)' INPUT DESIRED INITIAL X POSITION’ 
READ(*,*)XS1(1,1) 

WRITE(*,**) INPUT DESIRED INITIAL Y POSITION’ 
READ(**,**)X¥S1(3.1) 

WRITE(*,*)' INPUT DESIRED SPEED IN KNOTS' 
READ(*,*)SPDS1 

WRITE(*,**)' INPUT DESIRED COURSE IN DEGREES’ 
READ(** ,**)HDGS1 


XS1(2,1)=(SPDS1/60)*SIN( HDGS1*DTOR) 
XS1(¢4, 1)=(SPDS1/60)*COS( HDGS 1*DTOR) 


WRITE(**,**)' FOR SENSOR 2: ' 

WRITE(*,**) ' INPUT DESIRED INITIAL X POSITION’ 
READ(*,*)XS2(1,1) 

WRITE(*,**) ' INPUT DESIRED INITIAL Y POSITION’ 


$4 


READ(* ,**)XS2(3,1) 

WRITE(* ,*)' INPUT DESIRED SPEED IN KNOTS' 
READ(*,*)SPDS2 

WRITE(*,**)' INPUT DESIRED COURSE IN DEGREES' 
READ(* ,**)HDGS2 


XS2(€2,1)=C(SPDS2/60)*SINCHDGS2*DTOR) 
X$2(4,1)=(SPDS2/60)*COS( HDGS2*DTOR) 


DO 310 J=1,1000 
300 WRITE(*,*)' INPUT TIME OF UPDATE (NEG. FOR END OF PROBLEM) ' 
WRITE(*,*)' ENTER "9999" FOR SPEED AND COURSE UPDATE' 
READ(* ,**) TIME 
IF (TIME. LT. 0) GOTO 900 
IF (TIME. EQ. 9999) THEN 
WRITE (*,*)' INPUT NEW DESIRED TARGET SPEED IN KNOTS' 
READ (*,**)SPDT 
WRITE (*,%*)' INPUT NEW DESIRED TARGET COURSE IN DEGREES' 
READ (*,*)HDGT 


XT(2,1)=C(SPDT/60)*SINCHDGT*DTOR) 
XT(4,1)=(SPDT/60)*COSC HDGT*DTOR) 


GOTO 300 
ENDIF 


C UPDATE TARGET AND SENSOR STATES TO MEASUREMENT TIME 
Pe TIE Tie. 


C COMPUTE PHI MATRIX 
PHI(1,1)=1.0 
Pale, 2)=Dr 
PHI(1,3)=0. 
PHI(1,4)=0. 
PHI(2,1)=0. 
PHI(2,2)=1. 
PHI(2,3)=0. 
PHI(2,4)=0. 
PHI(3,1)=0. 
PHI(3,2)=0. 
PHI(3,3)= 


rea a OS OS SS 


RPooodwWor 
QS © @@ 


C UPDATE TARGET STATES 
CALL MATMUL( PHI, XT,4,4,1,TEMP1) 
DO 700 I=1,4 
XT(1,1)=TEMP1(1,1) 
700 CONTINUE 


GeUPDATE SENSOR STATES 


GO 
A 


CALL MATMUL(PHI,XS1,4,4,1,TEMP1) 
DO 710 I=1,4 
X$1(1,1)=TEMP1(1,1) 
710 CONTINUE 


CALL MATMUL( PHI ,XS2,4,4,1,TEMP1) 
DO 720 I=1,4 
X$2(1,1)=TEMP1(I,1) 
720 CONTINUE 


XDIEE 1=Si a) so Cie) 
YOIRPI=ST Ge leee 


XDIFE2=KT Cia a2 Cl) 
YDIFF2=XT(3,1)-XS2(3,1) 


READ(2,*)N1 
READ(3,*)N2 


TE (CASES GE 0.0) COTO 450 
N1=0. 0 
N2=0. 0 


450 BRG1=RTOD*ATAN2(XDIFF1,YDIFF1)+N1 
TF (BRG1.LT.0.0) BRGI=BRGI. Soe 
BRG2=RTOD*ATAN2(XDIFF2 , YDIFF2)+N2 
IF (BRG2. LT. 0.0) BRG2=BRG2+360 


WRITE(4, SOO)TIME ,XT(1,1),X1(351),245101, Dee ae 
3 PRG lecoc( l,l). 452 3 ee nee 
500 PORMAICIS org. 4) 


TIME tH Tis 


310 CONTINUE 
900 STOP 
END 


Seer es Goneteae ie i Ns ” 


CC owsdrvedrdesteciey Tiselsc nr sriselsichecine ire iie tse) ay tn ol rh khrlerioe iorierisclrricisirbror sears 
C THIS ROUTINE MULTIPLIES. TWO MATRICES TOCE IME 
C pe OIE nC )) mea Oe aCe N) 
CG vevedededededevedevevede deve de dete de deeds Toe Te ede Fe 76 Fe Te Ie Ie Tee Ne Ie Ie ee Ie Hee rise iererise arise tae) seis! 
C DIMENSIONS AND DECLARATIONS 

REAL*“4 ACL,M),BCM,N) ,CCL,N) 

DO 10 I=1,L 

DO 10 J=1,N 

CO = One 

10 CONTINUE 

icfor OIG = Le 

Den 100s= iN 

DO 100 k= 1,M 


86 








Lisl OF REL ERENCES 


meer ocott ©., Ihe Navys Revolution at Seca’: Surface Warfare in the 2Ist 


Century’, Armed Forces Journal International, November 1987, 


International Radto Consultative Committee (C.C.L.R.) Report 322, World Dis- 
tribution aud Characterisucs of Atmospheric Radio Noise, international Tclecom- 


munication Union, Geneva, 1964. 


[lall, H1.M., Stanford Electronics Laboratories Technical Report No. 7050-71, i 
New Model for fmpulsive Phenomena: Application to Aunospheric-Noise Conuntiti- 


cation Channels, August 1966. 


Spaulding, A.D., National Telecommunications and Information Administration 
Xeport No. 84-142, Locally Opiununn and Subopumiun Detector Performance it a 


Non-Gaussian literference Environment, January L984. 


Gelb, Arthur, Applied Optinal Estimation, M.1.Y. Press, Cambridge, Massachusetts, 
1D Zeb, 


Mitschang, George Wilham, An Application of Nenlinear Filtering Theory to Passive 
Target Location and Tracking, Ph. D. Dissertation, Naval Postgraduate School, 


Nlonterey, Caltfornia, June 1974, 


Bennett, Thomas Kevin, Development of an Adaptive Lxtended Kalinan bilter Ship- 
fracking Algoritton Using Bearigs-Only Measurements, M.S... Thesis, Naval 


Postgraduate School, Monterey, California, June 1988. 


Jazwinski, Andrew II, Stochastic Processes and Filtering Theory, Academic Press, 
Pew eyvork. New York, 1970. 





Meditch, J.S., Stochastic Optunal Linear Estimation and Control, McGraw-Ihll Book 
Mmomemew york, New York, 1969. 


Jomt Typhoon Warning Center, Guam, Martana Islands, /9835 Amual Trepical 
Crelone Report, Naval Oceanography Command Center/Joint Typhoon Warning 
Center, 1985. 


[oz @) 





pO. 


~] 


8. 


INEPIAL DISTRIBUTION LIST 


Defense Technical Information Center 
Micron Station 
Alexandria, VA 22304-6145 


Library, Code 0142 
Naval Postgraduate School 
Monterey, CA 93943-5002 


Chatinan, Code 62 

Deparment of Electrical and Computer Engimeermeg 
Naval Postgraduate School 

Mmonterey, CA 93945-5002 


Professor Haj A. Titus, Code 6271s 
Department of Electrical Engineering 
Naval Postgraduate School 
Monterey, CA 93943-5002 


Professor Jauregut, Code 62Ja 
Department of Electrical Engineering 
Naval Postgraduate School 
NIonterey, CA 93943-5002 


Conunander 
Naval Ocean Systems Center 
San Diego, CA 92152-S000 


Ron Maller 
Naval Environmental Prediction Research Facility 
Nlonterev, CA 93943-5006 


LY Wilhtam J. Galinis 


3425 Sherwood Blvd. 
Wemay Beach, FL 33445 


90 


ior 


Copies 








‘ % 














Thesis 
Glas 
Cul 


Galinis 


Fixed interval smooth- 
ing algorithm for an 
extended Kalman filter 
for over-the-horizon ship 
tracking. 





























ane - PHOT of sh Med b dt edewte ib pair cee oo ' ba Pe Ry nee gentle sheen, weg Vv) oe Fi | | '* Bae oS a) . . 
Fae etek gh ] j a Fey ree pnt, aba bird welt AGES oh ALAM LITO od oleh the sGi1 a ee ee . ' 1 7 
te ah SR shed ae Be cdotee s QLEth’ 4 pears. 8 


gtx om t 

cRusee, roe Te Sha nieitas Peer rewerey et et soceg | hi al orit 1m for a ” aes ; 

aarti ones §=Fixed interval smoothin * weer 

o ay ay te re se a 4 Steat ot x Ya sem ; 

nebainas DR pane § fiver ee y base tpcttens 2 ba ts ee e oe a Gaal fo, S bash 1} . . 

Lerman n katara hAzpue rE te Oy Mabel 4, far ra oD veer rw ers aoe >? 

DAVE RE Fr he etka ns b RAUB Lal Sp ol 18.0018, 10 42 AL fe Rh {Model eh nbaad ane Aa ceo 
jays ye a Pee wre! % sade mre A Sk a OAS 


rattae a | | of ote S "8 8 e 
| | | | oe ' ny Cee | e © ‘ 
| 4 | | | a | ry P 
at Males F.0R WEN 554.444) | tN) HH anal ‘ i | ® a ‘ P 
FOREAT D EPL Le 9h patna phic. betedey-s € athc BRAGLS 1b) 6, Mg Ait a8 dear h yy BO ei a! * i a | | | | | ‘ me gs ’ = 
nhentithv®. Jnarnense.his 204 A AS i: OIL AAS Sd VAT SIRE oy 2 Awe BG DOr A oy « | | | ) 18) | bau se Aah ; 
Ect eUs dehamn be Seay h rer KOR tic G3 Ried aliads Oh 8 OE OWrg* fil Bs 1 MBM abe) Micah hn US, eS oe } ] im || Lil ‘ és ' 











PDF PP OD Peak VAG 0 EF By AOD MS 18 OM Teh StF SAVORS IDG RY Dad Te M.D BaF OH Todas S685 “8 
MERE PD OD MARIE AA DOD Mi etom 1e de MULT YE bin tade. OHO 6D ASP AS chm AAFP Fu G 084 ‘ad 
pegt POP OA MeN eR hh AL abs Get wa, a bth 9b ad gy A Um ATR: CRA Ba gs Be Ree AaK. 1, Bede se. 4 











LF ee he 6 Re F A OG 4: B10 5E AOE 68 Sep dey eA UGS TASH SpAR TO mR AID EF Asd h OO e nae * ° é e , 
08 da eS PRM Mel By TMIOES INTER. OAT! EMO UG) were Fes Oleh FLORA R IOLA Rnb ock a ee =. OF 3 
RSM Re OOF. st Tol oath Aa RNID 2. CoMamer ian Bibb hRE AMAL Me HABE PAE 3 27 6 eg : ; 

hae minde Ce ‘ pe ; 





swonpes Rime ee ain gieyna of PR afl ste 2 Pa Ee tah tab Ps F 
RE ROL hye Leah 6 LAE Mee Rabati per» BS Aad Ih? Cae gy in eld ab hd 
phe ee Fe iabadnds tol baad deaeate etry aol «2 1G # Midd DER. Hast divs jit CatearhO: & Bah Aem 8 X LIBRARY fe ae e 4 . + = 
Se aera Pt PP On Sd Un Oe ae hae DUDL Hoge ‘ “i. - 
elimi Mame. Se oA ah Arte aka 6a wh. 2 ene, BE OMRD Wh eh CRKARA VE AG D1 oDre b 08hd GTM MO MONE Fh of mM FT evan ee Chea tee gf ota 
De ED ER DBASE Fat oft Mo Ah, Yay er re eee a ee) Ce eee ele Agh of oh . ~ ‘ * 6 e har . 
8a R BD An PONE RIO! Dhol fia KR MAON Oud taal, OU INOR OOS hse Eats tee & &. une ' ‘ .e : 5 6 . : a | shhh & ae ‘ Py 
PoFrhs BT ee a ee 2 eh dee Ahi Ae4 13-0 bon fb ds Fae : F t 0: 8,14,.6 as i “a on ' Sika e os (ade a a 3 r 
a*2veume 5 Kat o fro etyt se. n sn oe Fi: 8 nd So mbt, Ee LY Bm A stenls phot ise O.Foe & §- PP aT th Ai. 410 copaset nya & %y aves 45.e SUM | RB! wf j | e a ‘ ‘ is 
Me deluse wanina se J & Ue a ene Ol O08 ob We ac Se, & ae Ras ad BS eOh ait LE Ure re et Per rer a a ©. 0 Stee bd our A 9ela Fe & 2¢eret aed t . at end ae oe 
BPeReGhA rt, @ Ae ie. B deh obs BLAU OVE. fad ube it VENOOEABARE ES OAD Eke (MeL P OD OH ot BOF Bey Fad oder M Heb A KSEE Tia Le ae) Uk 7 ® , Ce ’ . ' « ‘ 1 r ‘ 
Piatt Oh VF ad hl EM GR Ott 14 A oh Fy Bet) Aol uh 16 1h ee HeeM dom Bad a t aoe. i; achat Oh =O a8 o* heer Ale “Ap Pw vid art a8 Cy Seek a ee 8 eB rT a a oe ' re | oat 
mesial que @ ox Ab tary: Aghent ahi neeting Payee te rete 2 ADT thot we eee ms Aa Why ARs ® S@ehedey ened 6 8 Hee Ml Led Wt DP o Es ae ‘ e,sfaee ‘ $16 ; 
Bad OF Hol rnd gh ib bok rh A 8 whe wh: OER d ed 3 ey be Peer eeeryr en Ta Lat ¢ Am het Hehehe Gs AA EW, OredK F Fan! alas & U6 We oton © ye tee ent: a6 aa Scat F a e 
(ame tle RS 5 «BA hash: 9 Fabae abt hee Li hed oan? eb Mee gdh crt iO 8 ke re ee eee melee 2 oe rer 8 Aa eat, Rote Ss O18 Bet } as at og 4° iz 
Cgh BiBUOSEE 10 ts CMAP ADS, Od Goh64N i abe. oF B tests wake OF Sher ee a eb A 4 Adel Loo Bes Cpe * opted ! Bak Ful bok 4 ot we ee a ee a? a & a ‘ 
Fee Foe A ohn G 2 00h why Fig Hird nb Fh Feb Lode tw Ainge BZ Oo OAR: OF. Mots OALERAM IE DHE, 420 Yt MO Mote ak NM Om Ohad eg'¢ O1@ 4 Bhat Gh te a? en err 
ee ee re KAMA A aid oh A VAOF eer tet Pint or bee LAA BE Sf HAE SA Beth Fat tts 4 & mate och 0 OO EAE. Sheth oe ov. b's) ea Phe Puce e 8 A 8 Fe me 
compar eb are ou SAS teen brates uh. 7 A of Baha ot, PRewhe bays SRA Maes ISIHe KAGEH HF” Ged eck ed Fane Le | i ce | Se 
Fa Ars. (MiG Asa eek vec ae coe SCOR nw i Car a Oe oe bee es heehee ae ot er) 4 reBUe Pepe osrPeant 
et er ke ee or eel D tiads ety ‘ abmenAs wad Qart Be . pEOCVEs Seh QA LE Bw. ah NED ee Ebon of eho celathya 9 fenton ot Y Cees oh ee are 7 te a: 
pi Oud off Wiebe hye He F bd MF Retveterty kab es» AM Meta Delt leer A tA Nes ot, Bs Ao AOD aR OL ASR bolas # BIE 2B & he eis Ce ee D) ' Ga see 8 
ra ind RM ale ale ctaviaem rete Ag vLAH Oey my icaece Rite OE ID Gy bet AAO BAUR tee ba aA § nwyes' § gw he hart Phe re eee ee ee : a eee s ae 
badd ofinked of Pednlichoresten reds oL Fah thas webob ot hak bt whe . ener ee oe eee tal TRAM In ses Ae nee ida sl 6 8 s) os ° 
RO ah! oot AGA CMA OH FEPON sn PoHl gh e AA DHS iP SURs A paeeang tree or ey es ehece ED Mit sant eye » wae S taf ef ow wt "0 e' 8,ee was fa 7) 
AS Slit toe tsb ab RKB 8198 Bigh, MOMR F eth ittes Be 2 : 
Lol gl Reh alen ett FF U2 A SRA YS h Ce | nb oft of Qhin® COO ah gh eM ONE ch EO doh BO iret CTY ire var tr) © ant “fae SOLA OTR wet mate el Ce AO sews neat we 2 twee ° a? ’ . t 
PTT WT in eid ble Po eR TP ee lr ieee Be Sore SO ee ee ee le i :s 4 Ane es at 
UMELD he RAE 6 Pema! uel er Becca BeD debe d plei bh so! Rol AOS A ATER EE: ite PIL ee Ty ae ry aan ee ee Looser are te tt OY Met Wa me ee] os , Cia Rie pete ae @ ‘ 
Dhyne Nv err ree eS Dhl o peakg hte heb @ AaB Ai det og. apts eer oe Pee) fafih etre Ahh Bah Oa Qt ¢ ve PRp ewnet @ @¢8 ‘ et P re sone ' ras 1 ee 
free hs St 0 alt ws pe pallet Sheplers PSPTY RT TROP eT fo Tit TIRES ee Ce ee rt Ps i taste 6 ea #e¢s € 8 8 ays ’ 
apg ees repel) TIT fg nebesghiAes SArases o Andbad # aban Hin: AaMAha R828 A Rid HRN AGU Real A Cnsed Crsed of im & ia sed 8 he Rimervenesuaese Ch Fete % om ‘ ‘ P 
retin poets Be qebindss wylabesy phantu sess? BURP Reames oF SGN WIR hr E RAG G0 OE 5 HEMT IEM. . OS OF Halo kshet sO wal eh At Oat fae Ooh b.90" nh © ‘ Gorst aa gter 2 @ aor e ete & 
so rp obs phi Sweeney hwy ere ee So Po Hof to oP a0 ol, Pereery Red bi awlawe wi Gt ge: em 42 -e Foes of le a Fis eee Kn rhe ‘ : 
ake bet ee fab VOGUE RLS Cut PAS OE: GAGD EES 18 .04k FRA AUMS BBA Det he AEGCARM EDO ofl MA Ghd O16 .060.8 F Boen ihe 8 BANG 8 or FO yen & tof tra * Cg & ® Ne ee aeF ae ' * 4 « £ep : 
Bt Wik otek CELE ABE He POM Lhe Khe MS oP. asad rad Gad eb uk A ohh BR eO Ake e ehh ay evs Feateas 20 MOLE Rimeh Oobig 7HP.9 1 Ob!) CORTE eee oh op Oe Fi hee & pox ri er Be eannactanee 
en a ee tre He Rall of Hot wlaka DA rpid ed ok we oft aks Fees pea pape TT AF HE ROE MIEN crm oh 8.8 Folkd 1tgGekek 2th M KE Bl Ate %eOAnt gage ites 6 6 ot 4 aPawe 5 ® Pay @r eg oe - mite 
PAAR G PARANA HAT ole G A A Sieh adel L Ory MP of, M Oboe FA EL PS) HOO 1.8 © bs oMiohaNok Fe CONPH LE Hib Cobth,* cl hide gecesi Gel Ft he ett et tg op Fete t pl ete . 5 * poh aiers eee 
«et oF abet tab an ope See rsd © Sail CECETARO ACA ACP oncUe she Pee Vet Anos Fe OPCs! con Vg h"F% «whe t. “v, ae) ee EY ee Aread Keg otst a am 8 eo ecete GO Fs Opp et « Ct en ageae P Pa a re ry 
Pernt Oak chalet abi H 58 phic eh oe Lap hinmiom if e108 Mle finth NEAR AES, Oy bel gl. ob MIA A LOMNETE WE tao POlg Ait « non SNe 1, Gren taV Ome © Ame Ore Ee 8 8 eCRUILY Se ey Corer ot at eps s&s 8 og ; eae 
BeAr ntahsVh xh Knl on crak Aeuekarak is #10 syn yito a0 Bade d: PS Cmte eee eee ee 2 MD abeh eet hot Oehed oe at 6 p eh etre A € ir See aRte g 6 etyres Py s * e 
AE A Aiki divhntnlige Sob dens wit OANA ot sob AWARE Fedde ANN OC tener) -K: Bote MG 1m RE abob el, 0.400006 ain CAE EC eg 4 8 GB 8 Bel 69 Pb oe ok Fa) a hae eens re ‘4 gn era 
er a te | aa) Cntea ede pmaevene” eAfee Me HE 19 Mtn Mol RIONO ED Hobs WOES odode et Hays AM rest 2 406, it er ee SO Ck i Pode Oe bee Ft ah ot & a.@ i Ae 6 r Py ' te 2 
Phil obid A iberatmbp hi ghOh yh phe beter € oe .pt ofl Or AE Oe ays MIN EL UbEES ENE Erk HOR: path Ook Bb ed ALLO Erm Hehehe eed WH ee oh Ae we aCe wot enc aie r @ hie | tee he 1° « anne ; A . 
eee ee og mpl ly Bi aBaGehs Mange st Hear one pebAt petabs rg oa nhogi ite Set fdens © (eter a §@ % q9058 dons emts « B64 see 2 8 ew OMe eg Es pet ae Hea BG 2 gt 0 eke ne c 
ae gt nested Relaeee ao wf Ph. Ai ay i? ottanet gaia Pe at 13,6 met gags RH AG Mol of aD hag sunt 4 oe 6 0 Bi Pesaeae A es md fh a ‘ . Aion & ‘ ' on? a P eon ' 6 
0 AF ale hott ate pail ch Sabana pn ry ge py x tree Aas. 010 matey #44 gee es are herd Osh © oe Map oats re ae oe i ee) “a8 4° Cans wt te WF Or oe es e 
meegesmeiayeed nyastnseiai was Oeste Cl ER hao Pater hel ord einen? hel © dm Od Atl bAov ties 1 ey A, 1 0.08 ih art 6 age shes e Sep LORE: efPrttes qe ‘ ae (8 a atens 
Dee Pet vnotnd we cies de he Rh ed 0 ch alel We whiese OSH em ee LAAYSH COP Eevee pers 1.0 eee das a Fé biwet Aes Bol Wein Mae 8 P eas" 8 0h Sct O%c @ seh ee Care oe aee 8 ra san 
tA SoS WEE A FGA pO Air bud ORL G at ot teninl Lrotee A erie Me Eada hee Ss ite SR ah Eton e ee a: 008 8 est ae oa beta 24 Poh etc eet A hse Gein ye 8 oecnrhae ~ tt ai 
Sie eaeaale alex PONV Met, Bed ewe Batok MAYO W 048k Cee bk wet AE teh AO IA Og OR MIE Ob re tBo? 6G Uw bes ie fe A A Re ee rr wr re i ee ge «4s ata bameaae ‘ s 6 
ace neat MAA idneed Ad oh tae eo AS ee AY bet bat sb 6 tae F 0hi8 sb ar thas ee i¢ wees 6 ee, tre wot HEP OM ES AHMET NO Miss wists a 000 fe oe 8 ‘ ect 
Bint ah eh 48 ow ee pe nfl ie! Bed sie mid 4 eget wea ghee at bee otto eae oF Roh, heel o a OShcae © ag thes or 8 8 lM tee "aes eces ee 1 Sieehls 6.) FQ" sepa ss 4 
job bO ad wak-o Da sc EPR RHO : Trae ceehien ule @ é ba tie ce oma Ye C060 618 Fehr we mand a tor 2 i Pieartete 2 & sola te wae ‘ Py e aia sce nene ue a 
satrecrabyns sot gastangtar teas aqhen’2 oF at Sgt 2 Reem ont, R he gh ete kat 8 orf or (An Bd! Monee ad . ah BANGLE Seb MYectseqarectsgs @ © 8 62 ave © Peage tage 6 &  aaey "pee oe a@ee fees , 
D Arpt ef OMe s Bread gn ded uens Tak iat kent ober Oden te ti Dp eC ayteeted 2 0hst.ag le we web hit ip. ake fam d Ghs-e 8 FS id oe oe Cy et ee e's ‘ ‘ 
BP ti AB OI O4 24% Kg tad e ae EE.) Cm bP PEN Mt A mm eeu och Reeen Pret) ie eee Oo le ea) rir YY Geek eee ee ee en ce ry ' a Sar sen. 1 soe et ‘ is 
naan OA Bee cha? of RA Pat Har ures as or he hat 1 doa JpAecBh 2h Sebo D).6 ob AF bo 06 Po SILO VY ed Ce ee a od Sak vh.ne s te € Gree cat ae eat ae Saat eae ‘ A e 
deg Fal aA nt line 0 adhe Rae 8 Oi bet wiry hace DOS ee Als oJ ad Wee ca ganyin 5a .@ Fp AL dee. t + ost atore Pea st He oF ‘ as entre *@ ese t 
actin, nAatinnad 06.0 0950 of hor beter Pho adalat fake? et ek shad tad fants Patt nt Se A ee ‘et stl ene te 
anette) nf éfe te! At waiter te hm Ace” “ata fob edadiad 26.08 ett out dee gaya WA sstel cee MS Ore enue h)™ wae 1s @.0 0 
sey eggs Brahe f 36) gat rd a bab ted 61d. oll Poh o4 om ke Nieet en ee ees ws e 99 06 ’ ae 
sondee ed! oh wh else wh aden Wider sik- 4: cmodnl GAYE ol 6 Pb OPED oF Sb 06 el pO damonal ids ata te Ble 
ne Pe Bel dh ed BED O68 BR Mia SM Palit H.W abarAtg bape os Re ex" @ plergivds& Pr) eee 9) e 
P ohat erin ted tbat ote tibees Orbost hewn tot eich, a ‘ weber We beret SAKE ate otal nr ne 40 Msg toned we a) i ae’ 
ppb ie gat ike OE a 16 'had of Kot AAD Be Mahe 0 OF v0 B Poked of Aleck wie) d egawas 0.8 Be theese o ne wigaee s bon Cam at See «less 
ST er Ae etal ied tL ee hater rare Ban vies ub eA Ulas abet eo 00 0s ee ee ee » Ahr he oe dveleye,aa rae | pom ages & tees ALR 
a ee FA ot hn achel ane 24 0ab Pal rR be kss skid ot AP cai Cw dgedei. 0 of beat F008 ry Sa sPiagye he yt At b-qe ete re ag cps omen 88 ache ge ee owge 7 ica) eat 
CAM Feb t OW aD: antiaD sod ob adad™ arene ae fap oR DOO Oee 0 ve wt oe ad erent dak Putian? os the ow: RB Spr e 4 OOH Be petireheg ORE v0 e te 1 presse aitle « 
fod Pinted oF 0 er Pea ae re eh abt bee adele ce the EMO Led ee Necse bY Papsd us 44 Fe cer se e @064 @ a eee ' saan) ae e 
Pt abut heh nk abe dehan ator bears 0 :Ru0 vesed eee 1h aye arr ere PO ro a und @ete @he 4 8 Re He * s% oe bee . ee 
Py et Ir, br bgp atest ke Oye ves 8 04 WA eb Phitnte ved endgt eel od 8 th eb Pda sa Ke Hare 2 ' 
en ences Se Spelman ine | wh ty O08 enlevers BF be: Or et ee ee 5.8 
Fudd  hytat™ 0M Bef Pere orth re ciated ois atone 6 Last Bg Mele? yO ght honsR bP me ad Apert gt ante Ore fol 
ay: haf Kec 8 Py ar Pete ee *n0y8 vehi ha ended oi a RiPe Cree gecems eee die ew, § hs 
Prot ol at eee Peer ise te Pee er ee orhae she Vecken* st ere@ F Fae 4.5 
Feiea the shee oo teen Foti & dhe rcad dead J. oa. care ot oh conan tsk gy eee erage tenet o% 
Oomph ab itn Par vied vokot eh of Potty ahd os phe bs, CEP dryeseel 6 Anstal of 
DR ped Pe 9: a a a p>, erst sea tab 
f to Og Ha Pan > ie of A Pet bia? D Ose de Te ed 
pte and am, $28 08s Tete D SD tater he un si Xoo oe ee 
natal ed at LA ee ee Ty ee Lt ee ee ytd ohne OF Pel owed 
Elie 6c bed Pew emek bbe \5 hat’ dea: O Fe eed ob akece q afede 
JD Dende PA Pa She ond sb oh bh atgernas dyloPaow dof 
ated ob de Bf aene sD abglitat Ot ee! whe Os ae af seat or Ne} © ate bnei de gti eas “ 
a eer ote cy. Qik ewe tab rea. CMs wo ge To ete ry Vy f Oar anGV00b 4 a 
Dino Pt ah oh as ae wend ae FF) Stroh ote st TT Pee tis od osete,@ Rea Pie@s © 48 
Ba eee Sf 3823 irk ALOT Lt ap uk “pad “ty "a, eK ne 2¢.c Ay iy al Pelt Led Cd ‘ 
Mpagrargigtyt oat Be Prdewettd abet Paes eb ee sone Meee ahs Rissa Aerat 
Maha ak das seb e a fe Sree ehie ie RI sae Avent Pi ve.fiert- oy ode 
SSE, ror ree nd : eT ub hee et 2iea aes re es ita ad - pf patedes oe 
ors, Bee usseade are rt ates stat ST Parr Sty Mediates int pu alte oe ma 
AF, & fe aD aati ie ewe et 60.8 Tie tame bi 016 ws Ace Hh DH oc adn? 
FREAK, 4 REAR TA Pate 2 bars iad oh Baa * ihe BENS basoe is ive 
iar: net = <a As) arbiph he LER s Saget 8 Oi tle Se 
ws! ete 
fam ae f raed in * is fo S : 


Ebb etgbiyind 
‘ A eens F é 4 . 
BaF Od tet eh nT al ah athe)» a td ¥} Lk 8 it 4 _ . bes 1 e e ‘ au ‘ 4s. eae oe * aare on 4 
PS Perr erent ek!) 337° . * e 5 F : , 
Berar Aehagle cd aiid of one Jenks be ie bk oF od 
ARO Ha nia ah ae : ad ie ur ee ee oan o whan ws 28 eo 
Ltd ER rt OR eI SSS Arr Uedtcon-8 of santa aera! aye it ate 
pace: BI. ae E NSS Fiz pode Fas ehved ane 4 i9y ends Fo Pies Nees Friys' of} 
BER Io Dbed ergs s PPS Lar Py rss dest as Awad RS lee ie Piste . 
Pee a et Le Cokie ab te tadabesh6a0 cere dea e Pele ter Bere bene ' 
EE ent eg PUDiBes Pad Pagheks FART bane J otaa, © MEAD OW 2 ae e they 
te Oe Se ee PLS SLY le aE ee TD see 3" pte Crerwce FAO eNs atime 88 
oA 2 eee te ee a ae WF ARF ee 1d Ws died, 2 
Fe bind 2D INAS Fader # 3f Meshes Totem Shh Wee | 
pRB nd Satie Peat ho Ais Recs ied 
whe. ots. we Me, FE, é» 


a wteid 
a ee 2 TOP M be oi of fat 
ee an AE Dube ab os Se ALS Pick 
Tepe ey ig TRA es eee d 
re ct ‘=: =! ods we ef \ 
Eo aut Pai Aine ERS t¥> APS | Bit &7: Fd 
", YM FD eae mel 3d 
ice Wine Steet re RF AT SREY 
Pie Wiser PIVAD Seis tL Fs iy at Plato W i. FS 
RSW ae SRAM F A oh sry TAH? is Perera hPa es 6 oF 
‘ a Soe SRI tet FS fv Py 3? RP wy Petar Let oe 
ae . Fk epee i = as Rie Muh Sets os a 642. Be 
xe hd -¢ ae bd 4 ee i ot we WD Lae: OP 


oe wf. f, 

PVVPT Py Seif? atte 

* ieee She ogreayl gr? 

Seay, Mey Ca 

he PBL? Farei-y 74 Speouenae oye te Fes 

tie Ls ithe ee Paes oF ; t sHyryew d 7 Seth 
ime Y TARR! ‘ MENS cing ats 

ioe ne Stet S. was baw tg) P 4 abewe 2 


TREY SIP oy 
af Pads Pus * aA Pet well Drie beet ; : | . r 
2: oF, usta AR 9 ry ryt 2 Pada e Bee rwy bot Pat ler Séteam? 2o* ©. ; ; 1? 3 sc 6, 17 fe ‘ 
ye by Baad By uae PPA aah MIA 4 tial ee SOF eal a wee Se Ane we ; : 

Agraere:ye 2x te PL ISe Ceram eis AARC. Waele oF ft Beh. 6 HEL deate Ale 
itt a AM Fie Tage Athy ss a P tly 730 a of Ay 243, Owl Wgetate se te.008 
ae ry fants 2 See ree iad Uae ag aD Reb A ease RS eon 
SAAT eh wy, +144 Ce et a phd Are leparerwret! MOP 5 ar, WL sige! i, 
carla pee ARR lata hatte “ena! fle at Wak wh) 7 TEs TH ded BT 2 age 

s RP Sat: 5, an Ee ten WE se. MPL IH aT ay ee 
“TE FU A egos ha are re SS Pw ar a1) RAN VW | - 
aed RR LSAT ieeet uo BR Anks RAL! Deere. 
po Se 


° 
F Pah the PATS pb rsassS "ty 
Pel ¥ > rarest tad Penh = 4 a 4g ary hy baka CE Beeb Lae Tne nS 
<b: Pak wpa ng = £4 ee Aa ges tS gaesy 

39 -S4Sy PTY Moser Fares ty porte + ye SEERR = 
4a soc ye in pai tot Mt aes eR, aes os 


al Uy ale ag 2-4 | Si Ks AN 

x Rep ats ot Se Sah 5 Pee my en 
. eae +7: 2 poe Wl cn Be hee Tees ass Fue AY, R 
mar serene SCA ree 2 3) oem 5 : enenp 3 

de he + a 7? eee Seat ott ta dd ase Na 2 ha Ge Ae oh 
pea est 4 yy berets at Fe eta oF ie caret oe | Sry 

fanees Peet 49- 3 ie Pte WS ek § st 19ee, 46 ee 

Fares Se yr Saat a7t Rigs hie 4: a3 4% Sean, Roe AEN 
is Phe Chiat eck boa) he 
‘Ey “et 
‘ 















































































































































Ys 9t ¢ 













¥ 








































































Se 8 Ge eet Cr 
















s.¢ 




























an re ae) Ot ee ae ee 
@ere we 4 fs ites 

































































-— ¢e 
o 
. 
- 
e 




























at ty ES, fe 
gba reres eae k | 
i, 2305S etn SAY Botel 
\easet Ss ae 6 de 
eit e “hele 
B,ePa op IR ay 


3” hl ees Pied] 9 a%s 35% 



























- 

o= 
4 
e 
e 

































ye" 








Pi 














a8 @ et yee 
wae 


= 


Lh A Ar Aa pA mt ght tr J ce 
ated Shaner aon Fetheprse fee ess ANPP gle Vee 
UT A eaten, ita tapes Bier ofasies Bove yn Yo ome 
= rth ae j*) ve I moter 
PDN HOVIMA TA STE. ete i: bc Ug Eos ras at yaw oie: ePuys Ve : ‘ ‘ Ci r 
OS Seas gesagte © BA Sees +) Ae, sete alee ese"? ont {0 8 oo ows ~RASS Bets see dae’, * les é ‘e ‘ bed 
soil taeehe igh atts Spl ag 4 or i sue . “satay ee A. aie * ‘ 7 Zy/e M- j 
> hd - = ~ 9 9%, uy a P| 3.8 ‘ 
SAP RiNrD ee = ares x2 Pe pas ohn past teat aed aX; . Nts, sy wr, 
Seat eenreerg mentale weye Whe A 780 Je Sly eye “ reese DIANA pst ‘ 
rinephiel wes, S « ag i A f b. 2 one #9; 
=< ge ig One riety ly SETS eee eR el ecie a ‘} Dact fe << aye . am » < Kp we) we. Nh . F 
SF? SS yrery rk~ws ~~ 2 Ct te aj brea elt =f j 
5 op part Reig 2 SHAR ‘ i: Tee ie SH: cme ~ 4 eh a s few, Pweg of a “ey 
ATR Ys wy = > +72 fake Mk pe = rargra ey XJ ae at in he 360% son uz ai oBte 
Ay OF Ow hy Oy ao he as ah Salata! = ape |= Pee hg Se ied A PET Msytaeejy COW mes sieyod 
2h he ee te 8 Ere oe Ny Spars sem gxralartiy $2 i Gg aly ees ad TR Ss, Pete 
FR ey he my ma epee be ys he oe Ose I [a 2% Yate tlhe) aay are wg sv arecintace: Re > 
SER SEALE EY pauses Pteigacts Hae Penk EX KS. 
3 ‘ < 7 $4? 
~* a see tae owe Wen s too Aer be tee Coa: & Ah bee n 
SSeS sb retires span sat gpg! ceonpeppyn =e ves we bah, © 4 ieerra Fy! ~ ee 22 is Her i : 
==, Cen Cree tenderer as te. eo8 Rem wh sOznt his Zee Sry ooh EM ‘* > 
ree slate bee “usuneseny be yee at tis? ngs eaieenae een, Baye 4 


eo" 
a 














FU 
Cee ns be dbviede a [hala ber wr) Poke aS Pa te tyes * 
<* ; rlelees As Oe be ve: fangs is "yy ighyre a rie 4%5 My dy ps 
—=28 Ty race Cure ta rh’ 3 es, ~~ Mt Mh, * Pe v3 
sped bie daa =p ada Bt roves Reve en ee Ste wre) A ele tae a! a 
het heh Be hohlartehted pcre Seas ye vei Bip. IP pe pie tur: arejes un Pro-e Hey afe ~ O82 WSR J & hah. | ' a. . 8 
co FESR ee ye ieere be iaethtele tell» Ue Sh 9h A 31985202 © Po ge Pape Oe ti, : a - 
Pa. eo Mere Mary, ‘eaten gah dy tata tpt iiss} ; ale oat Somters obese qresgis,em as KA ©, meV Ye 4 
epee Lael re ie Se wpa Pytetyeg ure Pure be af, Lepreay ris % Mw'n “y eyres Peewee sse HH, Peeves yet 
Fass been aah Uh bn nel rete mae ae ‘e ale. id aaah Lda 4 We e'O ofe wy ee Get MY Oem ro % . 
or. ddad hi dec NC tthe, te ce teeteliae x el, pre vee es cdl gal Fe [Pring Te hy Rees: tea Fh {td we Cem CNS : 
rep EOP FU OTA 98 awe ge | erent A aere® 4 At Lata AI Te de + 40r% id "an Phe » ae 
Roe! Sapo ncplost pace Sphatetntalstetabpiahtatitaabe® a da Sekt dade th Mis Bre he Po haby wee) ye a dee 
Sete Py Pee Pere te Legagndch dr’ ardent ae ela. & wre e a Vuk Wee Lhe Tis e) af me 2 oe & vi ree 
AF tor fre Gig OF hy Fatt iet linha seca eg aac sure Pein aL. ded fesenes! fy Pedy 3 
om 2S PWIA MYTG 5 USEIY NOt fe, mat sapeerse eyere x ery e tt v7e, OMe se Aw ie 
PyA mer open he ry Meg Ma Py EB TY Ae res Lens ray enry eT art, tt eae us & were yy aes ea og "ef 
Oe POT EEE arte WE IY Fer OS DIOL er inom, np "La tater nea chonoa ean Petey ST UPA FOR, ap are Meer eos veer ghee aah hse 
ge Py MEN hg ea POE SAMY SATE ES MAYS? OL ee Risley oud iq fete ada bey age. ha th tte Maks ot Td LP 
SUPE He? rea er pt fem tas ey] SpE He Wk secbocremeoew hc ose poze” te* ug - He 4 
bie Ye] Py Pye ee Fey Petro era eR wae m SYR E! a Racy haat canteen tn Mls Y iu abe ie us “sss es 
al erg cranute mtune tee rita la ty dv fe pf tae Ces teeary? SeTy's 4 rE wis WM eere, eye. res Freye om ct, true oR es . sige IN *.4 ‘ af 
me ag he’ = clsbeien bay ddl ta ey Oe bap Py rateiattc ° Jat dn: 5:8 Me esy at be = Esp sem b:1 7eew wie tate og 9 SHS 8 e * [ i t 
btn a teh ad Li Sh edly: hag omen ma ba Sa pa ityee | beats St So crake rey YC 8 eee vse ac wpe TES i 
te te Sh te ted ee tr he rt rake 'sht WSS eet arptoncerty 5 mupy se erith bal A *Ofage hy MuPy Trde Vp uv Fe edd OW re 4 “ey Dy: ey ere 4, er Pi <8 
weeere TS mraneNeATATHN # rer eenew Sie ore ayes restate rer Ota cag age te oe x B.C 2e Sita yy § TV Vie Cle ele aU Pee 8s 8 Nace O'R L : 
Sane ene Wem as eee eirenion neve, ee pote Shy hale Y.: .] my? TT ogee UNS TREY &hs 7 ay 6O% ¢ So OF at {Ps . ° ‘ 
Fiat Teh) ~~ Swi gee te Seperovets! & “wre «0% bat 4 bik acd rehy Nw me we =a 2 wr 8 ePP- eo ereise wt ie @s3 =s Vs 7 2 » 6 
Ap tyuatd neds oapeecearts eta cureh nies Rey ren Wass Pye rate myryers cere, ahaa eeiy Gye rere MM ry th Te 4 » © ashe *98 ’ 
ete eee WR RV WEE & “esa erp Ty a apa. ner “ope rateyy sory ret tore’ y Oy Hy «© Ra Sewers, 1% Si! Rees pid whe OP 8 ig, , - {We aa wv F 
batntonda late dtntedth atte £bge 5 ty Fe De, aig Riri ys ret ¢ eae a kata 4 Osh eT 9S Mees =~ eves Ooh - ere 18, Tala se PEs ste i ’ 
r a” Va lento om, aie i Tathfatekead us Pans kad, Fe fete than Bom pull Rh ark a Ferrera wer'sat © ayes # ve ooh OY wNe key 
patipetienites adie eh de ents ba hd, Posada Beet type Natl hea xpi ob pag min fy de Meee Gg a ee? Serer VASD 8 + Peig HN bbs se fs * i 
Ashe Atenicdar- dashed 04d tn'dhon Ady de, teak, eh phe Re anh a Ry tet Me eedie: WU omy Te a tiy OY ~ ate tf ra th vy a Le ee et » Ges . s 
on vse tn Tu TMrey as UNiCTe as Ours EOD erm Ge Ql a JL PP TORY ty Wh FOOFET TOYS L eM “7 | he ee “uruiew® acre oe ee Meme og 
~ Rien a Siestdpdipt oO: Meade ea tate Ft ha Bo uh Lh ke ee et Mee" h “opt a). arr rhe tem bree ' re Fate? 1 We KW .40e 8 a 0 . * e 
res EATS WE ey RAE Ny Hy He FOP EME heey MQ bee! Fu hs me Ok alte nie ochre ie; te evwby iy Die em ye aa eS eet Reey RB eS cee 
= b Joh dots rah, Bry aeons iptete 18 Fe Ce A OF ERO Py 8Y WFR: ote OEY Wee PDers He Su erase WO Se Rye Vem [Uw 14 ? iPbretrap Puy we © e788 | i>, bot tat * * ‘ % 
evarovali anian ce er © a MEET Petes ey My Oy tg Cer Re Me SOY hy Fut dred 9 OE MLIO, ty wre Ew Hn BD! ~ VuMmR » Owe rene @ omed we § tee i “ ry « 
be ede be, } eee Netra fhe eS ys 96 eth Hoe, 2 WWE Ee & QpeT ER .Tiwe m.cinte Beye owe & u:bm™ 4 OR TELE & «8M bossy & «xe v a € Ld be o° , et, 
os, ie pratt Py PRED 8 Umm OE Pw my My renare “are uryriyre) oA Wo acre Safe re, ge jewse Bt , “ate @ OY OTe iets wd =v vw © ® #,! ‘ 
eerie’ ee win Oy Orbe ere terry A fare ACHR Te rk Ne Pe 2 aleve & s re te eo sh ee ee Phe oe % a0 a ty ; 4 ‘ 
etree rere By Where eran ee My Mag Gre OEP EME S 6g FUG OP Pere Fees ia ohh we ite a Sey Aart FE ath oo VM ¥ - 0 ‘fe ' j r 
= rane see Weer g 4 0  & AEE Ney urwrer 49046 & INOS % Ie = 9 lege PA Ory e eryth 371,08 & EoereTe MN Pest shee ors arerw ss : 
ip is RS henenceane Tip ty Oy issih Tih Pade sa iindent tee Den bh Bh teh ee Be be deh Lak ea Te Sab meet Nerdy hg bated, efeWe cfoty & wr) emerple at v t om cy Ee « af sive = - e ’ 
SOS ED TS = wrevENEhS AOL te am 14. LRH Abe Wry OY Oy dg OTe Pe &, guwe 4 Pa th ae ee | res % why tye Bt oT eet) r 
nian oy wiry atolanintiely Tape S eeee me oh Swan re 75078 ayy "2 Que emer ysudgly \w ogre rere ee he he By al Sa 
atari Me Aiedek hetero tht Seu Seatdie e ekecteta CGMS Peg me fy EYRE SY “POY wruce be 44: re * 
Ta atetithiedidinatote} IN Fig 414 See Be Oe) Ate POIE OUT Ete Be wet At OM 9 WHE oe Bie oe 
Pherae eens! in Tyse ee Tn Y DRM PUe Sew 088 thee yy ere. “ay y 1%; hag wu’ are Sap. ory n 
sheen bola unison kesta ti eteehpoin se a ads Piola Sah Elta teens ta aa Tee gion tem Acar SePosrg SV PNET er ID ; 
Sender “eC PEs we BN OE) ceeelee ye saveele ye nee eur ange we CMTS Say UMM CE relUrh ae Cem ere ere@ n7g 0% 06 ost “¥.% ’ et a a r) 
Zaphie) Ey EEE Bay, PVD EP ey OD TE Me ot fag 0 9 TOT RRS HES vee ry nig MVE sepety on Com Ny "h ok § Wh rete a, “yt bhmess 68 Vem ae * e "boyy ma) A Y ‘ 4 
oe ne Aland ee nerve pierre wean beh mena wher yee te aE BIN SS sors 9 aby ate re Se Oh Sees Ae OA i UO s grasl be re b Viwre bias Bre ert a yi oe a y 
CAPT ORGS, Urry enn my Oe ME EEE Te YS radu lnc sina clbwan nara’ ue ty be tA Med he fe, ha ae rw Heel honle we MP uy viv were eee re ve te ee ae a e 
ea Gy Sey DlePIT OS tye BE eg TYPE hey Ob TUlire wry te jw, BMC Ee '® Tb see Pers Td Saat te Oe, te ta Ty Ba Pe "osm thy, ree wud er awe re § 
Oe AG STS he Perey. WED PR PONY Qertarnrs ter | ER WH Why wTE INE raed eA a hre HK ire wig ee NATS 2 fee Me ar eee mre ® ' See s 
PAG EMA Y OO Oy Rom Eee CR) S ORE ten fab De hy Sf apo exe yeh zoe’ 4 bday Byte Lid Yowre Upaer ey kD tq 
seg tire etin, Sn tan, Mb iar Ieplriadioesd nth, 2d, Srakde tenttin Lon Aisle, Sok te, a hes Tb NEUE 7 Oh wr ay Yee) e & on a mc PY Yppeers ere es OSE ow OE %, 8" 
Ante ie a ght Raa Bh yd pt Spipcide Alec eT lng eae ee Re SR ee Be VsR Ra LE. bide tad 7 .te% & ‘ ‘ a ™ 
Sra Fe vyFe > 0g We wg, ew Beer sy Ae PEEING HAE Oe Oy Dery OEsNED “ BUN wah Fyre a y Ory 'Q oy what VRla VERE j . 
ST eee Fue wus D8 re UE ROME Bnd erer’ “VE CNY rr y oad a one 6 6}°R pits eve OB a UN ts Dn J 
mat SE Se erate EMILE) ry Es Conllscke Te ptt PRD Oy FFD OD we EY OSG OPO SGT a vin & wo beeke a Es ¥ , 
FE e BATE TH OT ty Sey oy Gy wie hewek 2 SU W'S Gee Ye wives pi sousery: © Ws 27g TI Pe he a a ead ot Piet h Fores e - ® | % 
Oe GORE SR WG yy MOONY WIRD PSD yey 2 -R WON ney Sale ~ oy pk ce gq ity WER SD Hy ALVraere whe Wrst Swye % te HIRO DAM POY ’ | 
werd nach ep aly Beet nee rer sl oF wb & 07 4.) eR "Kr Sere et acer ee At Oe eres, ee ere rele Moe wb ey re 4 & Wit yer wy Y : 6 
ioein| aod ey hide yl Je HPO 1e arya Te yh s fa e's: " ¢ oynorete sep Sikh, Staph ieee, th Ta he Di he ates 2h A te ls Sed We a ‘ s 4% 
Mae te ith ds deh Oh tet oh LA oh Oo by etd Sh hh tha ae ne A Th te tak nok OA dk ch ceed ee he he Atte tA wee rE ve ve 4 + bes chey y « une 4 Xu ~ 
a toda sana by Te pee % We ry Nerecety elyre ince 'e-bry. where pa eS eceh yn nr eryneerynastiy, «6 we Vee we ow NG TEA ACK. a ~ e 
fe OE VRIES VB he defy Fh Fae he cuAG UCN | ae be te eo erate 2 ee ow tee » 7) es * cS at F 4 ‘ 
ate ye given guereyuretwance Sins ih Sh hn tor Ladd td be te Van ha Lh oa eked Sak te a t VEL eh thw 9 CMe hy << woh Pe PEN wee Geter ae Ugh : ‘ 4 ‘ e r ‘ 
Wt tre aw Pe Poe MRT ee th te rl te Mh ca ed MRL i tha wary O'S Cate wee ore 1 ot Vee hy 10 HL ey ae { ‘ al bh 
Md ied ror esk Womb Bh; be Uy Rye re ry ETRE FETE Ut ORM eke" rE TON TN, Are Leyla hous ap hh ‘ Eee fst s ? 4 
rte Mew BrETENe EIR bese) id Lh aa CPE MPN HD eG Mle WAL FES REY Oy 6-8 18 Shove acese 2, HUE P OMe one , 
a DNA PG dwely 28 Hg Sg BIS Mare UMN RWIS TE CUE DOTTY TE we UTOTEID yiuln'e ry fie EPA OO DUT ENTS OFEINh Se, fs MED é 
fi i id Sw eo eevee eo. pihey 9 ly he P WES CTO Rey EMD E re Ue Vee vd END. 6 Le Take p) w ah 
pa SS Serna WA Titestyurawea ren ery macyt Ah URe owes ory acest a) tem "Eee roo wR WY > 
~~ wdctarntinass-s Uw Grh a Y eee web: yee re Pele? ita Rie hb eg7hly D. HD Lt 
— eg an Ey 1 TS, SAVOY © a vie Wiehe sdK UR S hes d th Wbdesel Ah tae tol Se Ba th lis SD 
PRES SS 2.9 YES EG were | O'ER Ww Ne pela ph lid St at Whe ida ee ns ee Pe 





Hi 


2tbh 5 * 


rier “pe. acre ane a 
al ay 























































































= 
PR Wi kh ee el -t Qn ibid 1h of a 8 tad sam Oe Oe tt a ae seo , adel « t tetepe 


~ 


